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Preface 


The  Air'-Force  (and  the  Department  of  Defense  in 
general)  is  particularly  interested  (as  evidenced  by  the  fact 
that  many  of  the  references  used  in  preparing  this  thesis 
were  sponsored  by  Department  of  Defense  agencies)  in  research 
ifi  robust  control  systems  design  since  the  results  are 
directly  applicable  to  many  of  its  sophisticated  weapon 
systems.  Several  of  the  laboratories  in  the  Air  Force  Systems 
Commands'  Aeronautical  Systems  Division  are  helping  to  sponsor 
this  Air  Force  Institute  of  Technology  (AFIT)  Masters  thesis 
project.  The  primary  motivation  for  this  project  is  that 
many  current  control  systems  are  and  most  future  control 
systems  will  be,  implemented  in  digital  computers  and,  there¬ 
fore,  will  be  discrete-time  controllers  (Ref  7).  Furthermore, 
if  robust  controllers  can  be  used,  there  exists  the  possibility 
of  reduced  computational  and  hardware  expense . 

Thanks  are  due  Professor  Peter  S.  MaySeck  for  his 
invaluable  guidance  concerning  the  basic  nature  of  this  robust 
•>  control  system  study  as  well  as  the  final  format  of  this 

thesis.  I  would  also  like  to  thank  the  other  thesis  committee 
members,  Lt.  Col.  Carpinella  and  Capt .  Silverthorn,  for 
comments  and  guidance  during  the  final  preparation  cf  this 
thesis.  Special  thanks  are  due  to  Sandra  A.,  Todd  Q.,  Weston 
S.,  and  Jodi  S.  Lloyd,  my  family,  for  putting  up  with  me  during 
the  sometimes  frustrating  but  rewarding  task  of  completing  this 
thesis . 
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Abstract 

V. 

The  Doyle  and  Stein  robustness  enhancement  technique 
for  continuous-time  LQG  stochastic  controllers  was  investigated 
in  application  to  simple  examples  and  a  realistic  Apollo 
Command  Service  Module/Lunar  Module  Thrust  Vector  Control 
System  that  exhibited  severe  robustness  problems  in  its  initial 
design.  This  technigue  was  then  extended  to  discrete-time 
systems  in  two  ways.  First,  the  continuous-time  controller 
to  which  the  Doyle  and  Stein  technique  had  been  applied  was 
discretized  using  first  order  approximations.  Second,  an 
approximation  to  their  continuous-time  technique  was  developed 
for  sampled-data  control  systems.  In  addition,  an  attempt 
was  made  to  enhance  the  robustness  of  sampled-data  systems 
by  directly  picking  the  gain  of  the  Kalman  filter  within  the 
controller  structure  based  on  an  approach  similar  to  that 
of  Doyle  and  Stein. 

Sampled-data  controllers  were  designed  using  each  of  these 
approaches.  The  resulting  performance  analysis  for  each  closed- 
loop  system  was  based  on  the  time  histories  of  the  mean  and 
covariance  of  the  "truth  model"  states  and  controls  as  well 
as  on  the  eigenvalues  of  the  closed-loop  system.  In  both  tlhe 
discretized  continuous-time  and  sampled-data  cases,  significant 
steady-state  robustness  enhancement  was  observed.  Results 
for  picking  the  Kalman  filter  gain  directly  were  inconclusive. 
General  purpose  interactive  software  for  developing  robustified 
LQG  controllers  was  also  produced  and  documented. 
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I  Introduction 

The  purpose  of  this  thesis  is  to  demonstrate  a  syste¬ 
matic  procedure  to  design  computationally • efficient ,  discrete¬ 
time  control  system  algorithms  that  will  perform  adequately 
(i.e.,  at  least  maintain  closed-loop  system  stability)  when 
uncertain  parameters  in  the  system  design  models  vary 
significantly-  Such  a  control  algorithm  is  said  to  have 
stability  robustness  or  more  simply  is  said  to  be  "robust". 

This  introduction  provides  a  background  for  this  study,  a 
summary  of  recent  efforts  in  the  design  of  robust  control 
systems,  and  a  discussion  of  the  approach  taken  in  this  thesis. 
Following  this,  there  is  a  brief  discussion  of  the  notation 
used  in  the  remainder  of  this  thesis. 
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Background 


Stability  robustness  is  a  concern  in  control  systems 
Since  it  determines  if  control  systems  will  operate  in  a 
stable  fashion  even  though  certain  design  parameters  may 
change  from  the  nominal  values  used  in  the  design  of  the 
control  system.  One  reason  parameter  changes  may  occur  is 
that  a  systems'  physical  operating  characteristics  may  change 
with  environmental  conditions.  For  example,  aircraft  control 
systems  are  designed  to  operate  at  or  near  certain  flight 


conditions  in  the  flight  envelope  and  must  be  adjusted  when 
the  operating  point  changes.  Parameter  changes  may  also  occur 
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because  they  are  not  known  exactly  at  the  time  of  the 
controller  design  and/or  because  during  system  operation 
physical  components  may  fail  or  may  degrade  with  age  or 
environmental  conditions  (Refs  6  and  10)..  For  instance, 
in  designing  controllers  for  wing  flutter  suppression  in 
aircraft  and  thrust  vector  control  of  missies  and  spacecraft, 
tfie  bending  mode  description  of  these  flexible  vehicles  can 
not  be  specified  exactly.  Thus,  when  a  controller  is  designed 
based  on  the  nominal  description  of  these  modes,  the  actual 
closed-loop  system  may  perform  inadequately  or  become  unstable 
if  the  true  values  are  different  from  the  nominal  ones.  In 
addition,  characterization  of  the  bending  modes  may  change 
as  a  result  of  changing  loads  such  as  >rhen  the  fuel  supply 
decreases.  Two  additional  areas  of  concern  that  potentially 
affect  the  stability  robustness  of  control  systems  are  sensor 
failures  and  computer  wordlength.  Systems  can  be  designed  so 
that  a  certain  number  of  sensor  failures  can  be  tolerated 
Without  causing  unstable  control  system  operation.  Another 
equally  important  consideration,  computer  wordlength,  affects 
robustness  in  at  least  two  ways.  First,  if  a  control  system 
is  implemented  using  a  computer  program,  finite  computer 
wordlength  affects  the  accuracy  of  any  calculations  and, 
subsequently,  the  stability.  Second,  even  if  the  program 
results  in  a  stable  closed-loop  system  on  one  computer,  there 
are  no  guarantees  that  the  program  will  result  in  a  stable 
closed-loop  system  if  a  different  computer  with  a  different 
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wordlength  is  used  (Ref  1) .  Ackerman  (Ref  1)  and  Maybeck 
(Ref  10)  discuss  still  more  areas  that  may  affect  robustness, 
but  it  is  more  Important  at  this  point  to  discuss  robustness 
itself  and  to  consider  why  robustness  is  an  important  issue. 

Robustness .  An  automatic  control  system  that  exhibits 

the  property  of  stability  robustness  is  one  in  which  the  closed- 
«• 

loop  system  will  remain  stable  should  certain  system  design 
parameters  change  from  the  design  values.  More  precisely, 
robustness  specifies  the  finite  regions  of  the  design  model 
around  a  nominal  model  in  which  stable  control  system  operation 
is  preserved.  Although  some  papers  (Refs  6  and  13)  deal  with 
robustness  only  in  regard  to  parameter  variations  within  the 
basic  controlled  system,  robustness  actually  encompasses  all 
possible  variations  in  design  models  that  can  affect  control 
system  stability  (Ref  10) .  For  a  detailed  rigorous  discussion 
of  robustness,  see  Maybeck  (Ref  10) . 

Importance  of  Robustness .  There  are  several  reasons 
why  robustness  is  an  important  control  system  property.  One 
reason  is  that  the  models  used  in  the  control  system  design 
are  just  that,  models!  Subsequently,  no  matter  how  much  effort 
is  put  into  defining  the  system  model  there  will  always  be 
variations  between  the  model  and  the  physical  system  it 
represents  (Ref  10) .  In  addition  to  not  having  perfect  models, 
the  physical  components  of  a  system  tend  to  degrade  with  age 
or  environmental  conditions  (Ref  6) .  For  either  of  these  two 
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reasons,  a  control  system  must  have  robustness  if  it  ever  is 
to  attain  stable  operation. 

By  defining  robustness  properties  with  respect  to 
various  areas  of  concern,  systems  or  portions  of  systems  that 
require  additional  or  different  stabilizing  efforts  can  be 
pinpointed.  For  example,  certain  portions  of  a  control  system 
might  be  implemented  using  adaptive  control  techniques  when 
large  uncertainties  in  design  parameters  exist.  Actually, 
adaptive  control*  techniques  could  possibly  handle  most  systems 
with  uncertain  parameters.  But,  since  adaptive  control  is 
comparatively  expensive,  a  system's  robustness  can  be  used 
to  indicate  when  the  additional  expense  is  warranted.  Jt 
should  be  pointed  out  that  robust  designs  generally  have  some 
performance  degradation  when  compared  to  adaptive  designs 
(Ref  11) .  Furthermore,  robustness  studies  can  be  used  to 
determine  how  much  of  critical  control  system  components 
(i.e.,  actuators,  sensors)  such  as  those  onboard  aircraft  or 
Spacecraft,  should  be  implemented  in  quadruplex  redundancy 
to  guarantee  reliability  and  stability.  The  need  for  expensive 
quadruplex  redundancy  may  in  some  cases  be  reduced  by  using 
robust  control  system  designs.  For  example,  robust  automatic 
flight  control  systems  that  result  in  a  stable  closed-loop 
system  even  though  some  actuators  and/or  sensors  fail  are 
much  less  expensive  than  control  systems  that  require 
quadruplex  redundancy  (Ref  1). 
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Recent  Efforts  in  Robust  Control  System  Design 

Robustness  is  the  subject  of  several  recent  articles 
in  control  systems  literature.  Safonov  (Ref  15),  for  instance, 
in  a  paper  presented  at  the  1979  IEEE  Conference  on  Decision 
and  Control,  proves  a  theorem  based  on  conic-sector  tech¬ 
niques,  that  leads  to  a  precise  quantitative  characterization 
of  feedback  sensitivity  to  large-but-bounded  frequency- 
dependent  plant  variations.  He  points  out  that  an  interesting 
implication  of  fehe  theorem  is  that  there  exists  a  fundamental 
limit  on  the  amount  by  which  output  feedback  can  reduce  a  given 
plant's  sensitivity  to  frequency-dependent  plant  variations. 

In  an  earlier  work,  Safonov  and  Athans  (Ref  14)  discuss  the 
robustness  properties  of  a  restricted  class  of  controllers 
with  respect  to  large  plant  parameter  variations.  Specifically, 
they  suggest-  that  linear-guadratic-Gaussian ,  controllers  have 
the  desirable  robustness  properties  of  full  state  feedback 
controllers  (i.e.,  guaranteed  classical  gain  margins  of  -6dB 
.to  +00dB  and  phase  margins  of  +60°  on  all  channels  even  when 
implemented  using  a  Kalman  filter  for  a  plant  state  estimator. 

Doyle  (Ref  3) ,  however,  shows  by  a  simple  counter¬ 
example  that  the  results  claimed  by  Safonov  and  Athans  do  not 
hold  in  general  for  the  LQ  controller-Kalman  filter  combination. 
Since  then,  Doyle  and  Stein  (Ref  2)  developed  a  technique 
that  recovers  the  desirable  robustness  properties  of  a  full 
state  *e«dback  controller  that  uses  a  standard  LOG  controller 
in  which  the  Kalman  filter  gains  are  adjusted  in  a  particular 
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fashion  (to  be  discussed  later) .  In  addition  to  demonstrating 
their  technique,  they  also  show  that  other  frequently  mentioned 
techniques  to  recover  robustness  do  "not  work  in  general" 
unless  the  techniques  drive  some  observer. poles  toward  stable 
plant  zeros  and  the  others  toward  infinity  as  their  technique 
does . 


Approach 

This  study  wfll  be  concerned  with  extending  a  particular 
technique  for  designing  robust  continuous-time  controllers  to 
discrete-time  controllers,  since  the  current  trends  indicate 
most  future  control  systems  will  be  implemented  in  digital 
computers.  The  technique  that  will  be  the  basis  of  this 
study  is  proposed  by  J.C-  Doyle  and  G.  Stein  (Ref  2) .  Their 


technique  iff  directly  applicable  to  the  design  of  the  robust 
continuous-time  Linear  Quadratic  Gaussian  (LQG)  controllers 


with  uncertain  parameters  embedded  in  the  system  model.  The 
basic  idea  of  their  technique  is  to  add  pseudonoise  at  the 
control  points  of  entry  (See  the  Enhancing  Robustness  in 
Continuous- time  Systems  section  of  Chapter  II  for  a  discussion 
of  how  this  is  accomplished)..  Note  that  their  technique  xs 
restricted  to  linear  plants  that  are  both  observable  and 
controllable,  have  the  same  number  of  inputs  as  outputs,  and 
have  no  transmission  zeros  in  the  right  half  of  the  s-plane. 


In  this  thesis  a  relatively  simple  known  system  model 
with  a  single  uncertain  parameter  is  used  as  the  basis  for 
design  of  robus*t  controllers.  For  this  model  several  different 
controllers  are  developed.  First  a  continuous-time  LQG 
controller  is  developed.  Next,  several  different  approaches 
are  taken  to  adapt  Doyle  and  Stein's  procedure  to  discrete- 
time  LQG  controllers.  After  this,  a  procedure  described  by 
Maybeck  (Kef  10)  for  designing  robust  sampled-data  controllers 
is  used.  In  all  cases  above,  the  performance  is  analyzed 
using  a  covariance  analysis.  The  development  of  all  the 
controllers  and  the  performance  analysis  algorithms  is 
discussed  in  detail  in  Chapter  II.  The  results  and  conclusions 
are  discussed  in  Chapter  III. 

One  of  the  principle  by-products  of  this  thesis  is 
the  general-purpose  user-oriented  interactive  computer  program 
that  has  been  developed.  The  program  mechanizes  the  formation 
of  and  the  performance  analysis  of  robust  LQG  controllers. 
Appendices  A  and  B  describe  the  program,  Appendix  C  discusses 
some  of  the  considerations  that  were  involved  in  the  programming. 
Appendix  D  contains  the  software  verification  description  and 
Appendix  E  is  a  users  manual  for  the  program. 

Notation 

Before  leaving  this  introduction  it  is  necessary  to 
introduce  some  of  the  notation  used  in  the  following  sections 

of  this  thesis.  Random  variables  are  indicated  by  an  under 
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tilde,  i.e.,  x  is  the  notation  for  a  random  variable  x.  If 
x  in  this  case  is  also  a  vector,  it  will  also  be  underlined, 
i.e.,  x.  All  matrices  are  capitalized  to  distinguish  them 
from  vectors  and  underlined  unless  they  represent  a  one¬ 
dimensional  square  matrix.  All  other  notational  devices  will 
be  introduced  as  they  are  needed.  Additionally,  the  symbol 
'*»£"  is  read  as  "defined  as". 
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II  Robust  LQ3  Controllers 


Introduction  .  *- 

The  purpose  of  this  section  is  to  -discuss  the  approach 
taken  in  this  thesis  toward  designing  robust  Linear  Quadratic 
Gaussian  (LQG)  controllers.  In  particular,  robustness  with 
fespect  to  uncertain  parameters  embedded  in  the  system  model 
is  the  primary  concern  of  this  study.  Starting  with  a  rela¬ 
tively  simple  known  system  model  with  a  single  uncertain  para¬ 
meter,  Doyle  and  Stein’s  (Ref  2)  technique  for  designing  ro¬ 
bust  continuous -time  LQG  controllers  is  applied  and  the  per¬ 
formance  evaluated.  Next,  several  different -approaches  are 
taken  to  try  to  adapt  Doyle  and  Stein.'s  procedure  to  discrete¬ 
time  LQG  controllers.  In  addition  to  discussing  the  different 
controllers'developed  in  this  section,  the  software  used  to 
implement  the  design  and  performance  analysis  is  also  dis¬ 
cussed  . 

There  are  seven  major  subsections  in  this  chapter. 
First,  the  continuous-time  LQG  controller  and  performance 
analysis  is  introduced.  Next,  the  Doyle  and  Stein  technique 
for  enhancing  robustness  in  continuous-time  controllers  is 
discussed.  Then  the  model  to  be  used  in  this  study  is  intro¬ 
duced.  Following  this,  the  sampled-data  LQG  controller  and 
performance  analysis  are  introduced.  Next,  the  three  dif- 
^ c u*- n  c  i.ppr^.ciC re s  to  ex  it  u  o  « j -^ue 

to  discrete-time  LQG  controllers  are  presented.  The  first 
involves  simply  discretizing  the  continuous-time  controller 
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after  the  Doyle  and  Stein  technique  is  applied.  The  second 
is  a  sampled-data  controller  for  the  given  model  in  which 
Qd=gcont  At,  where  is  the  strength  of  the  assumed  discrete 
time  dynamics  noise  input  and  ^  is  the  strength  of  the 
assumed  continuous-time  dynamics  noise  input  from  the  Doyle 
and  Stein.  The  third  approach  involves  directly  picking  the 
I^plman  filter  gain  K  to  achieve  robustness  without  solving  a 
Riccati  equation  so  as  to  attain  the  desired  K. 


Continuous-Time  LQG  Controller 

The  following  development  of  the  continuous-time  LQG 
controller  is  based  on  Maybeck  (Ref  10) . 

The  LQG  controller  shown  in  Fig  2.1  is  an  optimal 
controller  in  the  sense  that  it  minimizes  the  cost  function 


V 


Jc=  E  >2  £  (tf)  Xf  X  ( tf )  + 


v- 

! 


'x(t)' 

T 

rw  (t) 

-XX 

”xu(t)' 

'x(t)' 

u  ( t ) 

_-XT 

w  (t) 

L— ux 

*uu(t>: 

_u(t) 

at  (2 


where  x(t)  represents  a  system  state  at  time  t,  u(t)  repre¬ 
sents  a  set  of  controls  applied  at  time  t,  is  the  cost¬ 
weighting  matrix  for  the  final  state,  W^x(t)  is  the  cost¬ 
weighting  matrix  associated  with  all  the  states  at  time  t, 
Wuu<t)  is  the  cost-weighting  matrix  associated  with  applying 
control  inputs  at  time  t,  and  W^u  and  Wux  are  cross  terms 

relating  cost  for  specific  states  and  controls  combinations. 
T 

Note  that  W  =  W  .  Note  also  that  E  is  the  expected  value 

"“X  u  “"vlX 
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1QG  Controller 


Continuour.-timc  LQG  Controller  (Ref  10) 


operator . 


For  a  physical  system  as  in  Fig  2.1,  the  state  of 
the  system  at  time  t  is  described  by 

x(t)  =  F  (t)  x(t)  +  B  ( t)  u(t)  +  G  (t)  w(t)  (2.2) 

where  w(t)  is  a  zero  mean  white  Gaussian  noise  output  of 
strength  Q  ( t ) .  That  is 

E  (w(t)  wT(t  +  t)|  =  Q  (t)  6{t)  (2.3) 

A  Kalman  filter  is  used  to  estimate  the  mean  of  x(t) , 
conditioned  on  measurements  of  the  form 

z(t)  =  H  ( t )  x(t)  +  vc(t)  (2.4) 

Rc(t)  is  the  strength  of  the  zero-mean  white  Gaussian 
measurement  noise  vc(t)  and  is 

E  |  v  { t )  vT(t  +  T)  j  =  R^t)  6  (t )  (2.5) 

The "estimate  is  denoted  by  x(t)  and  is  described  by 
the  following  relationships: 

x(t)=  F  ( t )  x(t)  +  B  ( t )  u(t) 

+  K  (t)  [z(t)  -  H  ( t)  £(t)]  '  (2.6) 

K(t)=  P(t)  HT(t)  R"1  (t)  (2.7) 

P  in  Eq  (2.7)  is  the  associated  error  covariance  and  is  the 
solution  to  the  foward  Riccati  equation 

P(t)=  F  ( t )  P(t)  +  P(t)  FT(t)  +  G  ( t)  Q  (t)  GT(t) 

-  P(t)  HT(t)  R“2(t)  H  ( t)  P(t)  (2.8) 
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x  and  P  are  the  initial  conditions  of  differential  equations 
given  in  Eqs  (2.6)  and  (2.8)  respectively,  where  these  are 
the  defining  parameters  of  an  a  priori  Gaussian  density 
function  for  x(tQ) . 

The  deterministic  controller  to  be  cascaded  with  the 
Kalman  filter  to  form  the  LQG  controller  is  described  by  the 
following  equations: 


u*  (t)=  -G*(tl  x(t) 


G*(t>«  W^(t)  BT(t)  Kc(t) 


(2.9) 

(2.10) 


where  u* (t)  is  the  optimal  control  to  be  applied,  £*(t)  is 

the  optimal  controller  gain  matrix  and  K  (t)  is  the  solution 

c 

to  the  backward  Riccati  equation  with  W  -  O. 

““XU 


-Kcit)=  FMt)  Kc(t)  +  Kc(t)  F  (t)  +  Wxx(t) 


-Kc(t)  B  ( t )  W^J(t)  BT(t)  Kc(t) 


(2.11) 


isc<tf)=  if 

(For  the  case  when  2'  see  the  discussion  in  Appendix  C .} 

Note  that  the  certainty  equivalence  principle  applies  to 
Eq  (2.9)  so  that  x(t)  can  be  replaced  by  x(t)  in  that  equation 
when  measurements  given  by  (2.4)  replace  perfect  knowledge 
of  x (t)  (Ref  10)  . 

Since  there  are  numerical  complexities  in  handling  the 
time  varying  LQG  controller  and  since  these  can  ofter  be 
neglected  in  actual  implementation,  a  constant-gain  time 
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invariant  solution  with  stationary  noise  inputs  will  be  used. 

That  is,  F,  B,  G,  H,  Q  and  Rc  will  be  constant  and  the  initial 
filter  transients  and  final  deterministic  controller  transients 
will  be  ignored  during  the  design  of  the  controller.  Therefore, 
in  this  case,  the  steady  state  error  covariance  P  will  be 
used  in  place  of  P(t)  and  steady  state  will  be  used  instead 
of  Kc (t) .  P  and  Kc  are  given  by  (Ref  10) 

p=  0=  F  _P  +  P  FT  +  C  Q  GT  -  P  HT  IT1  H  P  (2.13) 

K  =  0=  FT  K  +  K  F  +  W  -  K  B  W_1  BT  K  (2.14) 

— c  —  —  — c  — c  —  — xx  — c  —  — uu  —  — c 

Two  software  routines  were  written  specifically  to 
handle  the  Kalman  filter  and  the  deterministic  optimal  ron- 
troller.  The  flowcharts  and  source  code  listings  are  in 
Appendices  A  and  B  respectively.  Note  that  many  subroutines 
called  in  the  software  package  come  from  a  set  of  routines 
generated  by  Kleinman  (Ref  5)  and  modified  by  Floyd  (Ref  4). 

Continuous-Time  Performance  Analysis 

Since  the  control  systems  designed  in  this  study  are 
stochastic  regulators,  the  time  histories  of  the  mean  and 
covariance  of  the  truth  model  states  x, (t)  and  the  generated 
controls  u(t)  are  used  as  the  basis  of  performance  analysis. 

In  the  test  setup  of  Fig  2.2,  the  robustness  of  each  controller 
design  to  plant  parameter  variations  is  evaluated  by  comparing 
the  mean  and  covariance  time  histories  when  plant  parameter 
values  in  the  truth  model  are  varied  from  those  in  the  controller 
design  model.  The  truth  model  in  Fig  2.2  represents  the  most 
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Fig  2.2  Performance  Evaluation 

complete  and  accurate  mathematical  model  available  to  describe 
the  physical  system  to  be  controlled.  This  i’s  in  contrast  to 
the  model  upon  which  the  controller  is  based,  which  is  usually 
a  mathematical  model  of  much  lower  dimension  so  that  it  can  be 
readily  implemented  in  an  online  controller.  Note  that  if  the 
system  models  and/or  controllers  are  nonlinear,  a  Monte  Carlo 
simulation  analysis  would  be  required  instead.  Note  also  that 
a  time  history  of  the  quadratic  cost  function  Jc  of  Eq  (2.1) 
is  of  little  use  since  it  gives  no  information  as  to  individual 
channel  costs  (Ref  10) . 

This  test  setup  is  described  in  detail  for  the  discrete¬ 
time  case  in  Maybeck  (Ref  10) .  The  following  continuous-time 
performance  analysis  closely  follows  that  discrete-time  devel¬ 
opment  where  possible.  The  following  subscripts  will  be 
used  throughout  this  development: 

c=  controller  model 
0  t=  truth  model 

a=  augmented  model 
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cx=  state  controller  gain 
cy=  input  controller  gain 
cz=  measurement  controller  gain 

The  truth  model  dynamics  are  given  by 

kt=  Ft(t)  xt(t)  +  Bt(t)  iq(t)  +  Gt(t)  wt(t)  (2.15) 

The  measurements  available  to  the  controller  are 

z t ( t ) =  Ht(t)  it(t)  +  vt(t)  (2.16) 

The  initial  conditions  and  strengths  of  the  noises  in  these 
two  equations  are : 


E 1 

=  0 

(2.17) 

E  | 

!st(t) 

ft*  ♦ 

T))  = 

a* * 

►(  t) 

(2.18) 

E 

&"»l 

=  0 

(2.19) 

E  ! 

rp 

vi(t  + 

<v  v 

T)i 

- 

6(r ) 

(2.20) 

E 

=  sh 

- 

(2.21) 

E 

1 

0 

]  (* 

t(°) 

(2.22) 

In 

general,  the 

control 

input  u(t)  and  the 

controller 

states  will  be  a  function  of  the  measurements,  z,  the  can¬ 
't 

troller  states,  and  the  desired  inputs,  .  It  can  thus 
be  written  as  (Ref  ID) 

u('t)=  Gcx(t)  ^(t)  +  Gcz(t)  z{t) 

+  ^(t)  ^(t)  (2.23A) 
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2£c  <  t )  =  Fc(t)  xc(t)  +  Bcy(t)  ld(t) 


+  B  (t)  z  (t) 
— cz  —  t 


(2.22B) 


Note  that  in  general,  is  not  zero  but  that  in  the  case  of 
the  LQG  regulators  used  in  this  thesis,  y^  is  zero. 

As  stated  earlier,  the  performance  analysis  provides 
time  histories  of  the  mean  and  covariance  of 


Za(t)  =1 


*t(^ 


u  ( t ) 


(2-24) 


For  y„ (t) ,  the  mean  is  ni  (t) ,  the  covariance  is  P„_ (t)  and 

•— fl  — y  q  —V  a 


ya 


the  autocorrelation  is  V  (t)  (which  is  simply  P  (t)  +  iti  (t) 

— y  a  — y  3  — y  3 

— ya  (t )  >  • 

As  in  Maybeck  (Ref  10) ,  let  the  cost  be  described  as 


dJ 


c=  E 


at 


m 

*  £ 

k=l 


(2.25) 


where  c  . q  are  the  scalar  quantities  of  interest  and  are 

'  i  nm 

T 

linear  combinations  of  ya  given  by  q^=  .  For 

— ya  =  E  wk  2k  2k  then 
k*l 


dJ 


dt 


£=  E  \h  ya  Wya  ya  j  =  %  tr  Wya  Yya 


(2.26) 


From  these  relationships,  it  can  be  seen  that  4*  ,  and  thus 

—ya 

m  and  P  as  generated  in  the  performance  analysis,  will  be 
— y  a  — y  a 

of  importance  in  producing  Jc  if  desired  (Ref  9) . 

Now,  to  characterize  the  statistics  of  v  ,  the  statis- 

tics  of  the  inernal  process  x&  must  be  characterized  where 
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v  tfrftltr  HrfMUjWet  -I— T- -  i  WinT 


(2.27) 


f* 


-Sc' 


The  fiVei  step  is  to  eliminate  u_  ana  the  ac¬ 

tions  too  xt  and  fc.  Note,  tine  agents  will  **  nemovea. 
Tor  compactness  wherever  it  creates  no  ambiguities.  Button 

(2.15)  becomes 

it=  Et  St  +  st  (£cx  8c  *  ^cy  ^  ^  (Et  +  ^ 


*  2-t  St 


■  (It  ♦  Bt  Ht)  X,  *  Bt  2cX  So  +  &t  Scy  ^ 


*  Bt  Set  St  +  &t  St 


Eq  (2.23B)  becomes 


*  ,  p  v  +  B  (Ho.  ^,4-  ~ ■+, 

ic=  -C  £c  +  -cy  ^  "ci  _t  ~ 

r*  u 


) 


Letting 


[v 


£t 
t- 


(2.28) 


(2.29) 


(2.30) 


then 


t . 


■%" 


at 


0 1 


+  nH,  c.tt.t0m  «3y.  be  forme  a 
■r,  augmented  - 


ia=  Ea  Sa  *  ».  *a  *  S.  Sa 


,;ch  that 


(2.31) 


(2.32) 


where 
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(2.33) 


(% 


4= 


4= 


4= 


4  +  4  £c2  Kt 
.  4Z  4 


B'  G 
-t  -cy 


4  4x 
4 


l  -cy  J 


4 


4  4z 

4z  j 


The  initial  conditions  for  x„  are 


~a 


f  x_  ( 0 )  I  —  E 

[  x+(°) 

/V  u 

1  1 

i  2L,(0) 

=  x. 


(2.34) 


(2.35) 


(2 .361 


EII«a(V  -  Kf\- 

The  mean  covariance  and  autocorrelation  of  x^  are 


(2.3?) 


m  = 

E  | 

x  1 

~xa 

sral 

— x  x„  ” 

E 

1  T 

X„  x 

I  s?a 

a  a 

P 

E 

J(x  - 

~xaxa 

|  pa 

T 

c.  B* 

c.  d 


~V  ^ 


a  a 


(2.38) 

(2.39) 

(2.40) 


?he  time  propagation  equations  of  the  mean  and  covariance  are 


4.“  -a  4.  +  4  ^ 

d  d 


•  T  T 

F.  •  =  F.  p„  _  +  P..  ..  F,  +  G._  Q.  G: 

y X_  ^  A_  X_,  A  CX.  d  d  ”  u 

a  a  a  a  a  a 

or  alternately 


(2.41A) 

( 2 . 42A  ) 
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^  ^  =r  J  f  "t*  r r\  f't'^ 

“X_ V  1  O  ~X0  O 

CL  cL 


/  — a ^ ’  T  ^  t)  ^d(T)  d  7 


(2.41B) 


£v  y  (t)=  JL(t.  tA)  F  Y  (t  )  lf(t,  t) 


/  Ia(t,r  )  Ga  aa  fj(t,  r)  dr  (2.42B! 
"t  _ 


where  I  (t,  t  )~is  the  state  transition  matrix  associated  with 
—a  o 

as  given  in  Eq  (2.33)*  This  form  is  more  straightforward 
for  computer  implementation  when  time -invariant  systems  and 
controllers  are  used,  since  the  integration  involved  in  com¬ 
puting  I.a(t,  tQ)  need  only  be  accomplished  once.  At  this 
point  in  Maybeck’s  (Ref 1  0)  discrete-time  performance  analysis, 
he  presents-  the  means  of  expressing  the  cost  equation  ir.  terms 
of  the  augmented  vectors.  A  similar  derivation  is  not  done 
here  since,  as  was  mentioned  earlier,  computing  the  value  of 
•the  cost  function  Jc  is  rarely  of  practical  interest. 

Recalling  that  the  statistics  of  y  is  of  particular 
interest,  y^  can  now  be  related  to  x_  via 

T7<A 


•  x,  1  i  o  i  rx. 

y  =  = 

*  U  L^CZ  St  £«J  U 


h 

— cz J 


(2.-3: 


where 


(2.44) 


and  where  z  has  been  eliminated  from  u. 

Since  y„  is  a  linear  combination  of  variables  with 
known  statistics,  that  is  xa,  and  its  mean  and  co- 
variance  can  be  written  as  (Ref  9) 


~y= 


r  m  i 

-fflu  ■ 


■  I 

0  ' 

•  o  ‘ 

= 

G  H. 

G 

-x  + 
xa 

G 

— cz  — t 

-cyJ 

L~cy 

(2.45) 
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'  1 
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-cz 

I 

G  H.. 

G 

L  —  cz-J 

J 

1 — cz  — t 

— cx 

P 

"xavt 


’ 

m 

0 

T.T 

•  m  *  rp  * 

I  2j 

°  G(;„ 

—  — cz 

4- 

G 

~xavt 

0  gt 

L— cz  j 

L  —  — cx  J 

(2.46) 


It  is  obviously  necessary  to  calculate  a  value  for  P  in 

at 

order  to  use  Eq  (2.46).  By  definition,  P  is 

xat 

4..v/  E  |  |ja(t'  '  -x/:c,|  !*»<*>  -  EvJc)1T|  (2'47} 


1 1  ir.r  that  m,  =  J),  Eq  (2.47)  can  be  rewritten  as 
*w\ 
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c  =  r  |  ?  (■f's  +  \  „T  ('+■>} 

~XaVt  “'I  srt"'<  — Xa  v  w  '  is  t't]| 

=  £  |ga(t)  v*(x)|  -  z(  mx  (0;  v^(x)j 

v  a 

=  E  j^(t)  v*(t)|  -  mx  (0)  e|  j*(t)  |  (2.48) 

Note  that  the  expected  value  in  the  second  term  of  Eq  (2.48) 

T 

is  simply  the  mean  of  v. ,  which  is  zero  so  that 

«  A#X 

2* .v  =  Elga(t> 


(2.49) 


at 


Now,  using  the  solution  form  of  Eq  (2.32),  P  becomes 

xa  t 


-k  v  ~  E|  V*-  V  Sa<V 

a.  x 

[£a(T)  *d(T) 

xo 

:  +  la(T)  £a(T)Ut(t)  dT| 


(2.50) 


The  first  term  is  zero  since  x_(t  )  and  v,  (t)  are  assumed 

#*<=•  O 

independent  ana  the  mean  of  v, (t)  is  zero.  Now  after  expli- 

/*X 

citly  writing  out  the  augmented  matrices,  P  '  is 


xa't 


F  =  E 
~xavt 


f  ta (t,  r ) 
J  +  ^ 


1.4.  (  T  )  lcv(7) 

B  (t) 

-cy  j 


*d 


Gt(r)  wt(r)  +  Bt(r)  Q.cz(r)  vt(T) 


£oz(T' 


v;(t)  qt 

(2.51  )■ 
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-x  V 
a  t 


-  / 


la(t'  t)  e 


Ba (t)  Yd(T)  VX (t) 


I  £t(T)  Ht(T)  Y^{t)  +  2c2(t)  ^(t)  V^(t)  ' 

1  ^cz(T)  ^t(T)  ^t(T) 

CZ  r  r  (2.52) 

The  first  term  in  Eq  (2.52)  is  zero  since  Yt(i)  is  zero-mean 

and  the  only  random  variable  factor  in  the  expression.  Also, 

T 

the  term  with  G^(t)  w^(t)  vt(t)  is  zero  since  vt(t)  and  w^(t) 
are  assumed  to  be  independent  and  zero  mean.  This  leaves  a 
constant  matrix  multiplying  vfc(r)  vt(t)  as  in  Eq  (2.53) 


ix  v. 
a  t 


=  /  *a(t'  T) 


rBt(x)  Gcz(t)1 


*cz(^ 


E  |  Vt(T)  V^(t)|  dT 


(2.53) 


The  factor  E  vfc(x)  v£(t)  is  defined  to  be  Rt(t)  6(t  -  x) 
in  Eq  (2.5),  Now  applying  the  dirac  delta  sifting  property 
where  t  is  the  upper  limit  of  the  integration  (Ref  8) ,  Eq 
(2.53)  becomes 


v  *  ia(t'  t! 
a  t 


rstit)  £cz(t)  i 


Scz(t' 


h  Rt (t) 


(2.54) 


m 


The  state  transition  matrix  evaluated  from  time  t  to  time  t 
is  the  identity  matrix,  I.  The  factor  of  h  in  Eq  (2.54)  is 
a  result  of  integrating  the  dirac  delta  function  over  the 
range  tQ  and  t  instead  of  integrating  x  out  past  time  t.  The 
final  result  is 
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(2.55) 


% 
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P 

~xavt 


^cz 

~cz 


At  this  point  all  necessary  computational  forms  have 
been  derived  for  a  performance  analysis  of  a  linear  continuous¬ 
time,  time-varying  system  and  controller.  The  performance 
analysis  software  implements  a  time  invariant  version  of  the 
general  form  given  above.  Accordingly,  it  requires  G  , 

-cy’  ~cz  *  -cy’  J-cz  a-nd  -c  be  sPecified  for  Ecl  (2.23)  by  the 
user  in  addition  to  the  truth  model  dynamics  equation  and  mea¬ 
surement  equation  matrices.  The  flowcharts  and  Fortran  source 
code  for  this  software  are  in  Appendices  A  and  B  respectively. 

As  noted  above ,  this  is  a  general  performance  analysis 
routine  and  can  analyze  the  performance  of  any  continuous¬ 
time  controller.  It  will  be  used  in  this  study  only  to  char¬ 
acterize  tfie  performance  of  several  different  1QG  regulating 
controllers.  To  put  the  LQG  regulator  into  the  proper  format 
for  this  routine,  let  xQ  in  Eqs  (2.23A)  and-(2.23B)  be  the 
state  estimate  £  from  the  Kalman  filter  such  that  Eq  (2.6) 
becomes 


-f  -c  +  -f  - +  %  (^t  -  %  £c'  (2'56) 

The  subscript  "f"  indicates  a  quantity  associated  with  the 
Kalman  filter.  The  optimal  control,  lav;  for  an  LQG  regulator 
is  u*=  -G*  x  ,  implying  from  Eq  (2.23A)  that  G  =-G*,  G  =  0 

■  C  C  C  Jx  C  '  O  \' 

yA=  0,  and  G  =  0.  Nov;  substituting  this  into  Eq  (2.56),  it 

*a  ~C  7j 

becomes 

♦ 

Zf  -c  +  fif  (-^  Se>  +  Kf  <&t  -  Hf  2c).  (2.57) 
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Matching  like  quantities  from  Eqs  (2.56)  and  (2.23B)  implies 
that  for  the  LQG  regulator 


F  =  Fl  -  B,  G*  -  H- 
— c  —  f  — f  — c  —  r  -~f 


B  =  K, 
— cz  — f 


B  =  0 
-cy  - 


(2.58) 


(2.59) 


(2.60) 


The  flowcharts  and  FORTRAN  source  code  for  the  software  routine 
to  put  the  LQG  regulator  into  this  format  are  in  Appendices 
A  and  B  respectively. 


Enhancing  Robustness  in  Continuous -Time  LQG  Controllers 

An  automatic  control  system  exhibits  stability  robust¬ 
ness  when  the  closed-loop  system  remains  stable  even  though 
certain  system  design  parameters  change  from  their  design 
values  or  when  other  unmodeled  variations  occur.  More 
precisely,  robustness  specifies  the  finite  regions  in  parameter 
space  of  the  design  model  around  a  nominal  model in  which 
stable  closed-loop  system  operation  is  preserved.  Some  recent 
papers  (Refs  5  and  9)  deal  with  robustness  only  in  regard  to 
parameter  variations  within  the  controlled  system  plant  matrix, 
robustness  actually  encompasses  all  possible  variations  in 
design  models  that  affect  closed-loop  system  stability  (Ref  10) 
There  are  many  guarantees  of  robustness  for  control 
systems  designed  using  full-state  feedback  (Ref  10) .  In  many 
cases,  however,  full-state  feedback  is  not  available  or  is 
impractical.  In  these  cases  an  observer  or  state  estimator 
is  often  used  to  supply  estimates  of  all  the  states.  While 
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there  are  claims  about  robustness  of  systems  using  observers 
in  the  literature  (Refs  12  and  13; «  J.C.  Doyle  (Ref  3'  proved 
in  19?8  that  .there  are  no  robustness  guarantees  in  general. 
Since  then  Doyle  and  Stein  (Ref  2)  have  developed  a  technique, 
applicable  to  Linear  Quadratic  Gaussian  continuous-time  con¬ 
trollers,  that  recovers  some  of  the  robustness  properties  of 
3  full-state  feedback  system.  Their  simple  technique,  which 
assumes  the  n-state  plant  is  controllable,  observable,  and 
has  no  transmission  zeros  in  the  right  half  plane,  requires 
choosing  the  gain  for  the  Kalman  filter  in  the  controller  in 
a  particular  way. 

Doyle  and  Stein's  technique  is  based  on  making  the  re¬ 
turn  difference  mappings  for  full-state  feedback  controllers 
and  observer  based  controllers  equal.  (See  Fig  2.3).  When 
these  mappings,  or  loop  transfer  functions,  are  asymptotically 
equal  for  the  control  loops  broken  at  the  input  to  the  physi¬ 
cal  system  (point  x  in  Fig  2.3)  then  the  robustness  properties 
of  the  full-state  feedback  controller  can  be  ."asymptotically 
recovered  by  the  observer  based  controller  (Ref  ). 

The  return  difference  mappings  of  Fig  (2.3 a)  and  (2.3b) 
are  identical  if  the  observer  dynamics  satisfy 


Kf  [i  +  H  (s  I  -  F)-1  Kf]=  B  H  (s  I  -  F)-1  B  _1  (2.61) 


If  is  parameterized  as  a  function  of  a  scalar  q  ,  as  Kf(q), 

_ q  v  c.  %  (1 X  )  ^  _ _l.  o-  tb  ^ a  o  1 1 1  —  c;  u  u i; 1, o  -  6 u  j.  1.  j  a b  q-*-  O0  X I 


-f(q^  t  B  W 

q 


(2.62) 


..V-Sni 
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Fig  2.3  a)  Full-state  feedback,  b)  Observer  based  implementa¬ 
tion  (Ref  2) 


where  W  is  any  nonsingular  matrix.  When  this  requirement  is 
implemented  using  a  Kalman  filter  to  insure  stable  error 
dynamics,  K.£(q)  becomes 


Kf(q)=  P(q)  HT  R"1 


(2.63) 


where  P(q)  is  used  to  replace  P  in  the  matrix  Riccati  Eq 
(2.13)  . 

Using  their  technique  involves  changing  the  value  of 
G  0  G'  usea  in  £q  (2.13).  The}  define  Q  to  he  the  original 


G  Q  G  of  the  system  and  Q(a)  to  be  their  modified  Q  to  be 


used  in  place  of  G  Q  G  in  Eq  (2.13.  They  define 


»  i 


(2.64) 


f 


A  2  T 

0(q)=  Qc  +  a  B  V  B1 

where  q  is  a  design  parameter  and  is  set  as  desired.  Note 

that  q=  0  gives  Q(q)  =  Qq.  As  q  approaches  the  robustness 

properties  of  full-state  feedback,  controllers  are  recovered. 

Doyle  and  Stein  state  however,  that  some  robustness  may  be 

recovered  even  for  small  values  of  q,  i.e.,  for  q=  1,  10, 

100.  In  Eq  (2.64)  the  V  matrix  is  also  a  design  parameter 

with  the  stipulation 'that  it  must  be  positive,  definite  and 

symmetric  (Ref  1).  Note  that  Eg  (2.63)  physically  corresponds 

to  pseudo-noise  being  added  at  the  points  of  entry  of  u  rather 

than  the  entry  points  of  the  original  dynamics  noise  w(t) . 

When  Eq  (2.64)  is  the  basis  of  calculating  the  Kalman 

filter  gain  Kf,  the  steady  state  covariance  equation  Eq  (2.13) 
2 

divided  by  g  is 


then  as  q  +  * 


(2.66) 


r 

and 
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5  V  B* 


(2.6?; 


and  also  upon  making  appropriate  substitutions, 


B  V  BT 


(2.68) 


Solutions  to  Eq  (2.68)  are  of  the  form 


1 

q 


B  V5  (R*)'1 


(2.69) 


where  Vs  is  some  square  root  of  V  and  R*  is  some  square  root 
of  R  .  Eq  (2.69)  is  a  special  case  of  Eq  (2.62)  so  it  follows 
that  the  given  Qq  adjustment  procedure  in  Eq  (2.64)  will 
achieve  the  desired  robustness  improvement  objective  (Ref  2). 

In  the  evaluation  cf  this  technique,  several  different 
values  cf  q  are  used,  with  7-  I_.  Choosing  V/  1  allows  selec¬ 
tive  weighting  of  the  pseudonoise  added  to  each  state.  A 
•Fortran  software  routine  was  written  to  provide  for  the  ad¬ 
justments  indicated  by  Eq  (2.64).  The  flowcharts  and  FGRTRAK 
source  code  are  in  appendices  A  and  B  respectively. 


The  Model 

The  model  chosen  for  the  basis  of  this  study  is  the 
thrust  vector  control  system  for  the  docked  configuration  of 

-v-  -  r'  n  q  *v*  c  v-  ^  c.  y?  c  -y~  m'  p  c  rs  .•**  * ;  “  .n  ^  T  T  n  A.  —  c  T  ij 

Module  (LM).  Maybe ck  (Ref  6)  is  the  source  for  this  model 
description  and  contains  a  more  detailed  description.  There 
is  only  one  uncertain  parameter  in  the  system  description  used 
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and  that  is  the  natural  bending  frequency  of  the  docked  com¬ 
bination. 

The  Apollo  CSM/LM  vehicle  is  initially  aligned  using 
small  attitude  control  jets.  The  main  engine  is  then  ignited 
and  the  proper  attitude  is  maintained  by  the  thrust  vector 
control  system  (TVCS).  In  addition  to  this  function,  the 
T,VCS  also  attempts  to  counteract  any  rigid  body  rotations  or 
bending  motions.  This  is  necessary  to  minimize  the  stress 
on  the  docking  tunnel  between  the  CSM/LM  (Ref  8). 

Only  the  model  for  the  pitch  plane  with  the  most  signi¬ 
ficant  bending  mode  is  used.  The  rigid  body  motion  for  this 
system  is  described  by  (Ref  8): 

a(t)=  ~T(L°e  +  de^  +  T  L  ffi(t)  +  w(t)]  (2.70) 

A>  - - J -  j~  l  ~  J 

&(t)=  4*j(t)  • 71  ; 

whe  re 

w(t)=  rigid  body  angular  velocity  with  respect  to  the 
inertial  reference  frame 

6(t)=  angular  attitude  relative  to  inertial  space 
T=  thrust  of  engine;  22,000  lbs 

1=  pitch  moment  of?inertial  of  the  rigid  vehicle; 
370,000  slug-ft 

L=  distance  between  center  of  mass  and  engine; 

19  ft 

o=  slope  of  bending-mode  ax  the  engine  station; 
e  -.13  radian/ft 

d  =  displacement  of  bending  mode  at  engine  station; 

e  1.1  ft/ft 
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q(t)  =  generalized  lending  coordinate 

6(t)  =  main  engine  nozzle  angle  relative  to  the  CSM 

w(t)  =  a  svhite  noise  superimposed  on  <5(t) 

The  bending  mode  dynamics  are  described  by  the  state 
variables  v^(t)  and  q(t);  the  velocity  ana  position  of  the 
generalized  bending  coordinate.  They  are  related  to  the  other 
System  variables  by 

vfe(t)=  -u>b  q(t)  -  a  dg  [ 6  ( t )  +  w(t)j  (2. 72) 

q(t)=  v,  (t)  (2.?3) 

A J  n,D 

where 

a=  vehicle  acceleration  due  to  main  engine  thrust; 

10  ft/sec 

the  natural  frequency  of  the  bending  mode ;  value 
is  uncertain 

in  addition",  the  main  engine  servo-mechanism  can  be  modeled 
as 

6  (t)=  -1 A  6  (t)  +  1 M  6cCTn(t)  ;  (2.74) 

vhere 

<5  =  the  cornm£nde4  value  of  engine  gimbal  angle; 

output  of  controller 

T  =  lag  time  constant  with  which  the  engine  follows 
the  command;  .1  sec 

If  6  „ (t ;  is  Known,  for  instance  as  a  computed  input  (see 

deterministic  State  Augmentation)  then  6(t)  is  known  deter¬ 
ministically;  otherwise,  if  ^  (t)  is  random,  then  6(t) 

will  also  be  random.  Note  that  the  peak  rate  limit  of  .1 
radian/sec  will  be  accounted  for  in  the  cost  function  of  the 

31 


r 


f 


optimal  controller  (Ref  7). 

The  white  noise  disturbance  w(t)  occurs  as  vibration 
at  the  bottom  end  of  the  CSM  as  a  result  of  engine  firing. 

It  is  assumed  to  enter  the  equations  as  a_  random  thrust  vec¬ 
tor  angle.  Therefore,  the  true  nozzle  angle  is  composed  of 
a  deterministic  portion  <5(t)  and  a  statistically  random  por¬ 
tion  w(t).  The  mean  of  w(t)  is  zero  and  it  has  a  low  fre- 

2 

quency  spectral  density  of  0.0004  radian  per  cycle  per  sec¬ 
ond.  This  disturbance  could  cause  a  lateral  velocity  of  about 
2  ft/sec  during  a  100  second  engine  firing  (Ref  7). 

Combining  the  above  information  into  a  five  dimensional 
state  vector  equation,  the  vehicle  dynamics  are  governed  by; 
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(2.75) 


By  processing  Inertial  Measurement  Unit  (IKU)  data 
with  a  suitable  algorithm,  a  continuous-time  measurement  Zvt,- 
or  a  sampled  data  measurement  z(t^)  can  be  obtained: 
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( 2 . 7  6A ) 


y 


( 


z{x)=  e(t)  +  cr„  q(x)  +  v  (t) 

-V  **  Cl  **  C 

2(ti)=  6(ti)  +  aa  a,(ti)  +  v(ti) 


where  g,(t)  and  q(t)  are  as  before 


(2.76B) 


e(ti)=  e(t)  at  time  t=  t^ 
q(t.)  =  q  ( t )  at  time  t=  t- 

v ( t • )=  discrete-time  white  Gaussian  measurement  noise 

i.  rp 

with  mean  zero  and  variance  1/12(0.0002)^ 
radian^ 

vc(t)=  continuous-time  zero  mean  white  Gaussian  mea¬ 
surement  noise  of  strength  approximated  by  the 
strength  of  v(t.)  times  At,  the  sample  period 

over  which  the  measurements  were  actually  made 
Rc(ti)=  R(ti)  At 

oi=  slope  of  the  bending  mode  at  the  IMU  station; 

&  -0.13  radian/ft 


Note  the  approximation  to  Rc(t.  )  is  motivated  by  a  aerivatio 
of  the  continuous-time  IQG  controller  which  starts  with  a 
sampled-data  controller  and  then  allowing  the  sample  time  to 
approach  zero  (Ref  8). 

In  the  real  system  the  measurement  is  made  available 
once  every  0.1  sec.  z(t'!  can  be  written  in  a  more  compact 
form,  H  x(t)  +  v  (t),  as 


r  i 


U>(t) 


S(t) 


r.  '  -  \ 
r  [_ 

q(t) 

6(t) 


+  v  ( t  ^ 

~  c 


(  2 . 7V  ' 
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The  following  conditions  and  a  priori  knowledge  are 
assumed  and  are  consistent  with  those  used  by  Mavbeck  (Ref  3) 
in  an  adaptive  controller  for  this  model.  Eqs  (2.78A)  through 
(2.78D)  apply  to  the  truth  model,  and  Eqs.  (2.79A)  and  (2.79B) 
apply  to  the  controller  model. 


u  =  0.08  degree/sec 
o  3 

(2.78A) 

©Q=  0.8  degree 

(2.78B) 

r,  =  0.7  ft/sec 

(2.78C) 

Do 

q  =  0.07  ft 
o 

(2.78D) 

gj^=  (10  rad/sec)2 

(2.79A) 

(2.79B) 

2 

The  value  of  in  the  truth  model  is  set  at  various  values  - 
90,  100,  110,  200,  300  . .  rad2/ sec2 .  Note  the  J  in  Eq 

j-' 

(2.79A)  is  the  value  upon  which  the  controller  model  is  based 
and  is  different  from  that  in  the  true  model;  The  effect  on 
controller  performance  of  several  different  values  for  in 
the  truth  model  is  evaluated  (Ref  8) .  The  cost-weighting 
matrices,  as  specified  in  Maybeck  (Ref  11)  are 


W  = 
—xx 


( 


.4 (10)  00  0  0 

0  185000  000 

0  0  185000  0  0 

0  00  1100  0 
0  000  165000 


(2.80) 
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-uu=  [4‘4  ( 1 0 ^ 7  ] 

^xu=  [-4*M10)7  ( 


0  0 


(2 . 5i 


(2.82) 


The  entire  system  is  depicted  in  Fig  2.4.  In  Fig  2.4 
it  is  evident  that  the  driving  noise  w(t)  does  not  enter  the 
state  6(t).  Accordingly,  then,  only  four  states  can  and  need 
Be  estimated  by  a  Kalman  filter  in  the  LQG  controller.  The 
four  state  models  on  which  the  Kalman  filter  is  based  is 


W(t) 

£(t) 

d 

dt  vb(t) 
q(t) 


0.0815  w(t) 


Y*.  ( t ) 


q(t) 


1.13 


1.13 


I  6 (t )  + 

-11  |  -11 


The  deterministic  state  is  handled  in  the  manner  described 
in  the  following  section,  Deterministic  State  Augmentation 
section . 


Deterministic  State  Augmentation 

In  some  cases,  as  in  the  model  of  the  preceding  section, 
certain  states  of  a  controller  will  be  known  deterministically 
as  a  function  of  the  computed  control  value.  A  priori,  they 
are  random,  but  they  are  functions  of  the  computed  u,  which 
is  not  random  once  computed.  If  these  states  are  introduced 
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into  the  Kalman  filter  equations,  the  associated  Kalman  fil¬ 
ter  gain's  calculations  may  become  intractable.  In  particular, 
these  inputs  are  not  controllable  from  the  entry  point  of 
w(t) .  It  is  therefore  necessary  to  remove  these  states  from 
the  controller  design  model  while  generating  the  Kalman  filter. 
Following  that,  they  must  be  augmented  again  into  the  controller 
mbdel  (Ref  11) . 

Let  a  controller  model  and  the  measurements  upon  which 
it  is  based  be  described  by 

x=Fx+Bu+Gw  (2.84) 

z=Hx+v  (2.85) 

If  there  are  deterministic  states,  then  the  system  and  measure¬ 
ment  equations  may  be  put  in  forms, 


(2.86) 


(2.87) 


by  means  of  appropriate  ordering  of  state  variables.  The 

vector  X|  of  dimension  p  contains  all  deterministic  states 

and  the  vector  x ^  of  dimension  m  contains  the  stochastic 

states.  The  zero  matrices  in  the  partitioned  F  and  G  matrices 

indicate  that  there  is  no  direct  noise  inputs  into  states  x^ 

and  tv  =  t  is  not  directlv  couoled  into  x,  .  Note  that  F_, 

—/  -  —1 

t  0  allows  the  stochastic  states  to  be  functions  of  the 


deterministic  states. 


r 


Now  to  produce  an  estimate  of  •  a  Kalman  filter, 

for  a  system  partitioned  as  in  Eq(2.86),  can  be  determined 
using  Eqs  (2. 2 X  through  (2.13)  so  that 

0 

— 2=  -22  -2  +  —21  ^i  +  ^2  - 

Note ,  the  Kalman  equations  require  only  the  m  by  m  matrix 
and  the  m  by  r  G?  matrix  (where  r  is  the  dimension  of  w)  from 
Eq  (2.06)  in  order  to  compute  the  Kalman  filter  gains. 

Once  the  Kalman  filter  gains  K^.  are  determined,  it  is 
necessary  to  reform  the  complete  controller  model  as  in* 

Eq  (2.89) 
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(2.88' 
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K  xc) 


(2.89) 


Now  the  controller  will  provide  values  for  all  controller 
states:  known  values  for  the  deterministic  states  and  esti¬ 
mates  of  the  stochastic  states. 


Salaried -Data  LQG  C ontr oiler 

The  following  discussion  of  the  sampled-data  LQG  con¬ 
troller  is  based  on  the  presentation  by  Maybeck  (Ref 10).  It 
/  assumes  that  the  underlying  physical  system  to  be  controlled 

can  be  represented  by 
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ihi+1.  V  S(V  4  MV  g(V 


4  W  MV 


(2.90 


where  ,  t. )  is  the  state  transition  matrix  and  B.(t.)» 

1+ 1  i  — a  i 

G,  ( t .  )  and  w, (t.)  are  the  discrete-time  counterparts  of  B(t), 

— Q  X  1 

G(t)  and  w(t)  described  previously  for  continuous-time  systems 
Mote ,  if  the  underlying  physical  system  is  a  continuous -time 
system  as  in  Fig  (2.5)#  then  Eq  (2.90)  represents  the  equi¬ 
valent  discrete-time-representation  of  that  system  as  opposed 
to  an  approximate  discrete-time  representation  (Ref  10). 

A  sampled-aata  controller  for  the  system  of  Fig  (2.5) 
is  an  optimal  controller  in  the  sense  that  it  minimizes  J  in 
Eq  (2.91) 


J=  E  |  2  ^tN+1) 


+  E  i  [  xT(0  )  X(t.  )  x(t.  )  +  uT(t.  )  U(t.)  u(t.  ) 
i=0  1  ~  1  x  **  x  —  1  x  ~ 

+  2  xT(t.)  S(t.)  u(t.)|  |  +  E  J_(t.)  (2.91) 

In  Eq  (2.91)  is  the  cost -weighting  matrix  for  the  final 
state  which  occurs  at  the  final  time  t^+1,  X(t^)  is  the  cost¬ 
weighting  matrix  for  the  states  at  time  t^,  U(t^)  is  the  cost¬ 
weighting  matrix  for  applying  controls  at  time  t^,  S(t^)  is 
the  cost-weighting  matrix  at  time  t^  relating  certain  con¬ 
trol  values  to  certain  states,  and  J  (t. )  is  a  residual  cost. 
Note  that  the  applied  control  is  held  constant  throughout 
each  interval  between  sample  times  and  that  no  control  is 
applied  at  the  final  time,  . 
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Fig  2.5  Sampled-Data  LQG  Controller  (Ref  10) 


hhen-Eq  (2.90)  is  an  equivalent  discrete-time  repre¬ 
sentation  of  a  system,  a  complete  characterization  of  the 
states  and  cost  can  be  generated  by  simultaneously  integrating 
’the  differential  equations,  Eq  (2.92)  through  (2.98)  forward 
from  xime  t  to  t.  .  (Note  G^=  1  for  such  a  representation). 


I(t,  ti)=  F(t)  I(t,  ti)  (2.92) 

I ( t ,  ti)“  F ( t )  B(t,  ti)  +  E(t)  (2.93) 

I(t,  ti)=  F(t )  Q ( t ,  ti)  +  i(t,  ti)  FT(t) 

+  G(t)  Q (t )  G(t)  (2.94) 

X(t)=  £T(t,  W^t)  f(t,  ti)  (2.95) 
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u(t,  ti)=  BT(t,  ti)  Wxx(t)  B(t,  ti)  +  i^uu(t) 


_ m 

+  B‘ (t, 

V 

ti^  W-  +  ^xu(t^  °i ' 

(2.96) 

I(t,  ti)=  iT(t, 

ti )  Ixx(t)  l(t,  ti3 

+  IT(t, 

^)  wxu(t) 

(2.97) 

•  g. 

Jr(t,  ti)=  tr  ^^(t)  Q(t,  ti)J 

(2.98) 

Initial  conditions  for  all  integrations  are  0,  except  for 
£(t.  ,  t^)  =  £•  At  "the  completion  of  the  integration  to  t^  +  1, 
the  desired  results  are  S(ti+1>  t^),  £3 ( t  ^ )  =  B(ti+1,  t^), 

X(ti)=  X(ti+1,  ti),  U(ti)=  U(ti+1,  ti),  S(ti)=  S(t.+1,  ti) 
and  J.r(ti)=  Jr(ti+1»  t^).  The  integration  must  be  performed 
for  every  sample  period,  except  in  the  case  of  a  time  invar¬ 
iant  system  model  with  constant  cost-weighting  matrices  and 
stationary  noise  inputs  with  fixed  sampling  period,  where  the 
integrations  need  only  be  performed  once .  In  this  later  case , 
t'he  I,  and  G^  matrices  in  Eq  (2.90)  and  the  X,  U  and  S 
matrices  in  Eq  (2.91)  are  constant  matrices  (Ref  10). 

For  a  system  described  by  Eq  (2.90),  the  LQG  regulator 
consists  of  an  optimal  deterministic  state  feedback  control¬ 
ler  cascaded  with  a  sampled-data  Kalman  filter  as  in  Fig  (2.5). 
The  Kalman  filter  provides  an  estimate  of  the  states.  This 
conditional  mean  estimate  x(tT)  is  described  by  Eqs  (2.99A) 
through  (2.99E). 

x(t7)=  £(t^ ,  ti_1)  x(tT_1)  +  B<J(ti_1)  u(ti_1)  (2.99A) 
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•;>  a 

■■-v  \ 


* 


P(ti)=  i(t-,  t.^)  Plt^j)  I  (t.,  t._15 


+sd<ti-1>  Sd(ti-1> 


K(t±)=  P{ti)  H  (ti) 

[H  ( t  i )  P(tT)  HT(ti)  +  R(ti)  j"1 

X(tt)=  x(t~)  +  K(ti)  Jzi  -  H  ( t  i )  x(t")j 
P(tt)«  P  (t~ )  -  K(ti)  H(ti)  P(t~) 


(2.9 SB) 

(2.99C) 
( 2 . 99D) 
(2 . 99E) 


The  initial  conditions  necessary  for  beginning  the  recursions 
indicated  by  Eqs  (2.99A)  through  (2.99E)  are  the  a  priori 


knowledge  of  x  and  P  ,  that  is, 
— o  — o 


*(to)=  *o 


£(toJ=  *o 


(2.100A) 

(2.100B) 


Q^(t^)  in  Eq  (2.99B)  represents  the  covariance  of  the  assumed 
zero  mean  input  noise  w^(t^),  that  is, 


E  l^d(ti)  ^d(tj)!  = 


fid(ti> 


fci  tj- 


V  tj 


(2.101) 


z^  in  Eq  (2.99D)  is  the  measurement  available  at  time  t^  and 
is  of  the  form 


z(ti)=  H(ti)  x  ( t  i )  +  v(ti)  (2.102) 

where  v(t^)  is  an  assumed  zero-mean  measurement  noise  of 
covariance  R(t^),  that  is, 


\  iV-V* .  - . 
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V  ( t  -  )  V ' 1  ( t  .  ) 

<v  -*■  J 


s(V  V  t.i 


t .  /  t  . 
r  3 


(2.103) 


Note  that  w.(t.)  and  v(t. )  are  also  assumed  to  be  independent 

JCTu.  1  /v  1 

of  each  other.  The  description  of  the  various  matrices  and 
vectors  in  Eqs  (2.99)  through  (2.103)  parallels  the  continu- 
qus-time  case  wixh  xhe  excepxion  that  there  are  now  two 
values  for  x  and  P.  The  value  at  t7  is  the  value  before  the 
measurement  at  i.,  z-(t.),  is  incorporated.  The  value  at  tt 
incorporates  the  new  inf ormation  made  available  by  the  mea¬ 
surement  at  time  t.  (Ref  10). 

The  optimal  deterministic  controller  to  be  cascaded 
with  the  Kalman  filter  in  Fig  (2.5)  is  described  by 


u*(ti)=  -GJ(ti)  x(ti) 


(2.104) 


Eq  (2.104)  assumes  perfect  knowledge  of  x(t^)  at  "the  sample 
time.  Since  the  certainty  equivalence  principle  applies, 
x(t.)  can  be  replaced  by  x(tt)  when  knowledge  of  x(t.  )  comes 

•  1  u-  i- 

from  incomplete  noise  corrupted  measurements.  G*(t^)  is, 
from  deterministic  LQG  conxroller  theory  (Ref  10), 

2J<V'  [Uttp  .  S^ttp  Kc(ti+1)  Bptp];1 

•  [Sj(ti)  Kc(ti+1)  t(ti+1,  tp  +  Shtp|  (2.105) 

where  K  (t^)  satisfies  the  backward  Riccati  recursion 
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Sc<V=  S(ti>  -  iT(t1+1.  tt)  k^Vj)  zr, 


-  [ «d‘V  VW  i(,W  ti) 
+  §T<VlT  sj<V 


(2.106) 


^C^N+l^  -f 


(2.107) 


*  Flowcharts  and  FORTRAN  source  code  required  to  imple¬ 

ment  the  sampled-data  1QG  controller  appear  in  Appendices  A 
and  B  respectively. 


Sampled-Data  Performance  Analysis 

This  performance  analysis  is  based  on  .Fig  (2.2) ,  with 
the  only  difference  being  that  a  sampled-data  controller  is 
used  versus  a  continuous -time  measurement  controller.  This 
perf ormance “analysis  scheme  is  from  Maybeck  (Ref  1C) . 

In  this  scheme  the  truth  model  is  represented  by 

x+(t)=  F+(t)  x+(t)  +  B  (t)  u(t)  +  G.  w  (t)  (2.108) 

and  the  measurements  available  to  the  controller  are  sampled- 
data  measurements  of  the  form 


!t(ti)=  W  iPV  " 


(2.109) 


The  discrete-time  controller,  which  is  similar  in  form 
to  Eq  (2.23A)  and  (2.23B),  is 


H<V*  £cx(ti>  *c(tP  *  £«<V  zti 
+  £cy(tP  *d(tP 


(2.110A) 


2c(1W'  Sc(ti+1'  V  W  +  BCZ<V  Hi 

*  Hy{ti‘ 


(2.1103) 


The  primary  differences  between  Eqs  (2,23.)  and  (2.110)  are 
that  the  differential  equation  is  replaced  by  a  difference 
equation  and  that  the  counterpart  to  z^t)  is  written  z^as 
epposed  to  z^t^)  (Ref  10). 

Using  a  controller  as  described  in  Eq  (2.110),  and  an 
equivalent  discrete -“time  model  for  the  truth  model,  the  sam- 
pled-data  performance  analysis  is  very  similar  to  the  contin¬ 
uous-time  performance  analysis  where  x^t)  and  ^ (t )  become 

x„(t.)  and  y(t-).  That  is,  if  in  Eqs  (2.27)  through  (2.35) 

~a  i  «s  i 

xc(t),  x^t),  xt(t),  xt(t),  F^t),  Ft(t),  are  replaced  by 

-c^i+l^'  ^c^i^’  ^t^i+l^’  srt^i^*  ^c^i+l’  ti^’  -t^i+l’  ti'1 
respectively.  Then  F£  (t)  becomes  t£(ti+1,  t^),  E£(t)  becomes 

E ,  (t. )  and  G_(t)  becomes  G ,  (t- )  where  the  upper  left  parti- 
C_  1  a  Q.1 

cx  d 

tion  in  G  is  the  identity  matrix  I,  since  this  is  an  equi- 
‘valent  discrete-time  representation.  If  the) underlying  truth 
model  is  a  discrete-time  system,  an  appropriate  G^  would  re¬ 
place  the  1. 

The  mean  in  (t. )  and  the  covariance  P  (t . )  of  the 
_xa  1  xa  1 

internal  process  xa  are  propagated  by 

Ex  <W*  ti''  *x.(V  + 

a  <s.  a 

(2.111A) 


(2.111B: 


4/W=  -(ti+i'  V  4  <V  I  <Vi’  4 


rn 

4_r*  / 4-  ’N  r\  /  a.  '  r*  ■*■  (  ~\ 

^dQ  ui;  W'  ^  ui' 

3.  3.  3. 


The  mean  and  covariance  of  the  augmented  vector  of  desired 
quantities,  v  ,  are  given  as  a  linear  combination  of  the  sta- 

-v  & 

tistics  of  xQ  consistent  with  the  definition  of  v  (ReflO) 

a  3  Sira 


%-„(v= 


I  o 

SWV  VV  s^v 
0 


m  (t.  ) 
— x„  1  1 


v  .ft. ; 
“-Q  1 


(2 .112.4) 


<V‘ 


I  0  ■ 

2.44)  MV  &W 


VV 


I 

0 


m  m  * 

4z(V 


&<V 


G  (t.  ) 
— c  z  '  1  ‘ 


R(ti)  [o  £cz(4}  ]  (2 . 112B ) 


Eqs  (2.111)  and  (2.112)  will  give  an  accurate  descrip¬ 
tion  of  the  desired  statistics  at  the  sampled  times  t  ^ .  How¬ 
ever,  it  is  often  desired  to  Know  the  statistics  at  particular 
moments  between  sample  times.  The  differential  equation  for 


(*)  is 

*  ^ 


Za(t)= 


r  * 

£t 


L^t 

tv 


rn<w 


Bt(t; 

0 
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X+ ( t ) ' 

At  b 

+ 

•Gt(t)- 

J 

.  u(t). 

0 

w  (t) 

tv  ^ 

(2.113) 


■■ 


■sV-iw-.,.,  w-s<L*; 


Based  on  Eq  (2.113).  the  mean  m  (t)  and  covariance  (t; 


-y* 


are  propagated  between  sample  times  by 


SL,  (t)  = 


-y 


Ft(t)  Bt(t)] 

0  0 


m  (t) 


(2.114A) 


P  (t)  = 

'Ft(t) 

Bt(tr 

P  (t)  +  P„ 

O' 

Ml 

-V 

0 

0 

0 

[Gtjt)  Qt(t)  G^(t)  0 

0  0 


(2.114B) 


The  initial  conditions  for  the  sample  period  beginning  at 

time  t . .  come  from  Eq  (2.112).  Note  that  no  P  (t. )  terms 
1  xavt  1 

appear  in  Eq  (2.112B)  as  they  do  in  the  continuous -time  coun¬ 
terpart,  Eq  (2.46).  This  is  true  when  w^tt^)  and  xa(t0)  are 
assumed  independent  of  v, (t.)  (Ref  9). 

/V  ^ 

The  optimal  LQG  regulator  must  be  put  into  the  form 
of  Eq  (2. 11  OB)  to  be  evaluated.  The  optimal  LQG  regulator 
"has  the  control  lav/ 


u*(ti)=  -G*(ti)  £(tT)  (2.115) 

With  y^=  C  the  necessary  associations  are,  from  Maybe  ci:  (Ref 

10), 


£cx(ti,=  -£J<V  |I  -  &<V  S<V| 

£cz(V' 


(2.116) 


(2.117) 
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Ic(t1+1,  V'  V  -  MV  MV| 

[i  -  K(t^)  Kitp] 

MW  li(ti-n’  ti>  -  MV  MV] 

•KtV) 


B  =  0 

-cy  - 


G  =  0 
.-cy  -- 


(2.118; 


(2.119) 

(2.120) 
(2.121) 


where  the  |_,  B d ,  G*  and  the  filter  gain  K  are  those  associated 
with  the  controller  design  model. 

Since  there  are  minor  differences  between  this  per¬ 
formance  analysis  and  the  continuous-time  performance  anal¬ 
ysis,  only  one  software  routine  was  written  to  accomplish 
both  of  these  performance  analyses.  External  flags  set  by 
the  calling  routine  indicate  to  the  performance  analysis 
routine  whether  it  is  to  perform  a  continuous -time  or  dis- 
-crete-time  performance  analysis.  Flowcharts* and  FORTRAN 
source  code  for  the  performance  analysis  appear  in  Appenaices 
and  B  respectively. 


Doyle  and  Stein  Technique  in  Discrete-Time  Systems  -  ,1 

This  section  describes  the  first  approach  taken  in 
this  thesis  to  try  to  extend  Doyle  and  Stein's  (Ref  2)  tech¬ 
nique  fcr  enhancing  robustness  of  continuous -time  LQG  con¬ 
trollers  to  sampled-data  LQG  controllers. 

In  this  approach,  the  continuous-time  LQG  developed 
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T5- 


using  Doyle  and  Stein's  technique  is  merely  discretized. 

This  discretized  controller  must  be  put  into  the 


performance  analysis  format  which  requires  values  for  G  (t.), 

Gcz(ti)  and  Gcy(ti)  in  Eq  (2.110A)  and  ^(t^^  t±)  ,  B^tt^ 

and  B  (t.)  in  Eq  (2. HOB).  Since  G*  (t)  is  constant,  G  (t.) 

— cy  1  — c  — cx  i 

=  -G*  where  the  control  law  has  become  u(t.)=  -G*  x  (t.). 

— c  —  l  — c  — c  z 

G^z  is  zero  and  since  0,  so  is  Gcy.  Then  for 

the  controller  of  Eq  (2.23B) 

xc(t)=Fc(t)  xc(t)  +  Bcz(t)  zt(t)  +Bcy(t)  id(t)  (2.23B) 
xc<t^+1j  in  Eq  (2.110B)  becomes 

[I  +  *'  IScz^i1  •  At  [Sti 

/ 

+  [®cy(ti)  At  ]Xd(ti)  (2.122) 

where  At  is 'the  sample  time  and  I  +  /f  (t.)  At)  ,  B  (t.)At 

*  \  c  1  /  C  Z  X 

and  B  (t.)At  are  first  order  discrete-time  approximations 
cy  l 

of  *  (t-,,,  t . ) ,  B  (t.)  and  B  (t.)  required  in  Eq  (2.1 1 OB) 

c  x.  >  i  x  cy  x  c  2  x  , 

(Ref  9) .  Also  note  that  a  discrete-time  approximation  of 
R^ft)  is  required.  From  Maybeck  (Ref  9)  an  appropriate 
approximation ,  R (t^) ,  is 


R(ti)=  Rc(ti)  /At 


(2.123) 


Recall  that  F  ,  B  and  B  are  defined  in  Eqs  (2.58) 
— c  — cy  — cz 

through  (2.60)  and  are  described  in  terms  of  the  continuous¬ 
time  controller  model  matrices,  the  Kalman  filter  gain  (which 
is  calculated  using  Doyle  and  Stein’s  technique)  and  the 
deterministic  controller  gain. 


The  Doyle  and  Stein  Technique  in  Discrete-Time  Systems  -  2 

This  section  describes  the  second  approach  taken  in 
this  thesis  to  extend  Doyle  and  Stein's  (Ref  2)  technique 
for  enhancing  robustness  of  continuous-time  LQG  controllers 
to  sampled-data  LQG  controllers. 

In  this  approach,  a  sampled-data  LQG  controller  is 
ueed.  In  order  to  apply  the  Doyle  and  Stein  technique, 

G^  Qd  G^  in  Eq  (2.99B)  is  replaced  by  Q^.  In  this  controller, 
Qd  the  assumed  discrete  dynamics  input  noise  strength,  is 
related  to  Q(q)  of  Eq  (2.64)  and  is 

2d  2d  2d  +  q2  Bc  V  At  (2.124) 

•T 

Eq  (2.124)  is  a  format  similar  to  using  G  Q  G  of  the  contin¬ 
uous-time  system  multiplied  by  At  as  a  first  order  approxi¬ 
mation  to  Qd  (Ref  9) .  At  is  the  sample  period  of  the  sampled- 
data  controller.  Note  that  the  subscript  c  in  Eq  (2.124)  is 
to  indicate  that  the  B  matrix  is  the  continuous-time  model 
B  matrix. 

Flowcharts  and  FORTRAN  source  code  for  the  software 
necessary  to  implement  this  approach  appear  in  Appendices 
A  and  B  respectively. 


Enhancing  Robustness  of  Discrete-Time  Systems  by  Directly 
Choosing  K 


The  third  approach  to  enhancing  robustness  of  sampled- 
data  controllers  involves  directly  picking  the  Kalman  filter 
gain  K.  This  approach  is  related  to  that  of  Doyle  and  Stein 
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for  continuous-time  systems  in  that  a  similar  strategy  of 
^  making  the  return  difference  mappings  for  a  full-state  feed¬ 

back  system  and  an  observer-based  system  asymptotically  equal 
is  used.  Fig  (2.6a)  shows  the  full-state  feedback  system 
while  Fig  (2.6b)  shows  the  observer-based  suboptimal  control 
law  configuration  where  u(t. )=  -G*  x(t7)  instead  of  the  opti- 

mal  control  law  where  u*(t. )=  -G*  x(tT).  Note  that  the  label- 
«  —  1  — c  —  1 

ing  in  Fig  (2.6)  indicates  that  this  analysis  is  done  in  the 
z-domain  versus .the  s-domain  for  continuous-time  systems 
(Ref  10) . 

The  return  difference  of  the  full-state  feedback  and 
the  observer-based  design  need  to  be  equal  in  order  for  the 
observer-based  design  to  recover  the  robustness  properties 
of  the  full-state  feedback  controller.  That  is,  kJ  is  to 
0.  be  found  such  that 

£  K  [i  +  H  (z  I  -  £)_1  £  k]"1  = 

[H  (z  I  -  f)'1  B^]-1  (2.125) 

Note  that  K  is  the  steady-state  Kalman  filter  gain  and  i  is 
the  state  transition  matrix.  If  K(q),  parameterized  as  a 
function  the  scalar  q  as  in  the  continuous -time  case,  is 
selected  such  that 


Liin  £  K_  R  ,,, 

q-*o>  - -  %  ii 

q 


(2.126) 


# 


for  any  nonsingular  m  x  m  W  then  Eq  (2.126)  is  satisfied 
asymptotically .  K  is  thus  chosen  as 
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Fig  2.6  (a)  Full-state  feedback  (b)  Suboptimal  control  lav.’ 

u(ti)=-^*  £{ tT)  (ReflO) 

K=  q  §_1  W  '  (2.12?) 

Nov;,  q  and  V{  can  be  varied  as  in  the  continuous -time  case  to 
achieve  the  desired  degree  of  robustness.  Note,  in  the  dis¬ 
crete-time  case,  K  is  chosen  directly,  as  opposed  to  choosing 
s  2(q'  ir.  the  continuous-time  case  (Eq  (2.64))  and  then  cal¬ 
culating  a  K  based  upon  the  solution  to  the  matrix  Riccati 
Eq  (2.13)  (Ref  10). 

Kaybeck  (Ref  10)  indicates  there  are  many  possible 
choices  of  W  in  Eq  (2.12?)  above  but  that  one  particular 
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choice  is  motivated  by  considering  the  dual  state  equations. 
This  choice,  Eq  (2.128), 


v 

W«  (H  I'1  B,)"1 


(2.128) 


assigns  m  eigenvalues  of  the  closed  loop  system  to  the  origin 
and  the  remaining  (n  -  m)  eigenvalues  to  the  invariant  zeros 
iff  the  system  for  a  system  of  n  states  and  m  inputs. 

In  order  to  use  the  performance  analysis  algorithm, 
the  suboptimal  control  law  must  be  put  into  the  proper  format. 
The  proper  format,  from  Maybe ck  (Ref  ID),  is 


Ie<t1+1,  V-  i(ti+1.  tp  [l  -  Kttp  Http] 


(2.129A) 


-  MV  s*<v 


(2.129B) 


Bcz(ti)=  I(ti+1,  t.)  K(t.) 


(2.129C) 


G  (t.  )=  B  (t.  )=  G  (t .  )=  0 
— CZV  1'  -cy  1  — 


(2.129D) 


where  £(t-+1,  t^),  Bd(t^),  G*(t^)  and  the  Kalman  filter  gain 
K(t^)  are  those  associated  with  the  controller  model. 

Flowcharts  and  FORTRAN  source  code  for  the  software 
necessary  to  accomplish  this  choice  of  W  and  to  vary  the 
parameter  a  appear  in  Appendices  A  and  B  respectively. 


53 


Ill  Results  and  Conclusions 

Introduction  t 

This  chapter  discusses  the  results  and  conclusions  of 
this  study,  based  on  data  generated  by  the  interactive  computer 
program  written  to  support  this  study  (see  Appendices  A 
through  E  for  program  description) .  There  are  several  items 
about  the  following  discussion  that  need  to  be  addressed  at 
this  point.  First,  the  following  discussion  of  the  various 
controllers  and  performance  enhancement  techniques  includes 
data  obtained  for  the  software  verification  models  (Test 
Cases  1,  2  and  3)  that  are  introduced  in  Appendix  D.  Second, 
the  Apollo  model  state  vector  was  rearranged  to  meet  the 
software  requirements  for  handling  the  deterministic  state 
(see  Deterministic  State  Augmentation  Section  of  Chapter  II) . 

In  this  rearrangement  the  original  states  1,  2,  3,  4,  and  5 
become  states  2,  3,  4,  5,  and  1  respectively,  that  is 


xT=  [i  (£  9  yb  q]T 


(3.1) 


Third,  when  discussing  the  results  obtained  for  the  Apollo 
model  only  states  1  and  4  (6  and  v^)  will  be  used  to  demonstrate 
performance  since  the  behavior  of  states  2  and  3  is  similar 
to  that  of  state  1  and  state  5's  behavior  closely  resembles 
that  of  state  4,  wrhich  is  the  state  most  direclty  affected 
by  changes  in  Fourth,  even  though  the  time  histories  of 

the  mean  and  covariance  of  the  states  and  controls  form  the 
primary  basis  on  which  to  judge  closed-loop  system  performance. 
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the  eigenvalues  of  each  closed-loop  system  are  computed  and 
examined  to  determine  stability  (prior  to  running  the  mean 
and  covariance  analysis).  Last,  the  matrix  design  parameters 
V  and  W  in  the  two  performance  enhancement  techniques  are 
always  1-by-l  matrices  for  the  applications  considered.  They 
are  thus  always  set  to  1  since  any  desired  change  can  be 
accomplished  by  adjusting  the  appropriate  scalar  design 
parameters.  The  order  of  the  discussion  is  continuous-time 
controllers  first,  discretized  continuous-time  controllers 
second,  sampled-data  controllers  third  and  finally  remarks 
about  some  general  trends  applicable  to  all  three-controller 
types. 

Continuous-Time  Controllers 

The  steady  state  performance  of  the  continuous-time 

controllers  without  first  applying  the  Doyle  and  Stein 

technique  for  the  three  software  verification  test  cases  is 

presented  in  Table  D.2,  Appendix  D.  The  steady  state 

performance  of  the  controller  for  the  Apollo  model  is  displayed 

2 

in  Figs  3.1  and  3.2  for  of  the  truth  model  set  at  100  and 

2 

400,  respectively  (oj^  in  the  controller  design  model  is  set 

at  100  for  all  cases).  Figs  F.l  through  F.3  of  Appendix  F 

show  Apollo  model  performance  for  several  other  values  of 
2 

^ .  Note  from  these  Figs  that  the  closed-loop  Apollo  system 

2  2 

is  unstable  for  u,  <  50  and  >  400  (evident  in  state  4 

b  —  a-  — 

only  for  this  last  case)  . 
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When  the  Doyle  and  Stein  technique  is  applied  to  Test 

Cases  1,  2,  and  3,  the  performance  is  improved  in  the  sense 

that  the  density  functions  are  more  tightly  packed  around  the 

2 

mean  values  (state  estimates  known  more  precisely)  as  q 

(the  Doyle  and  Stein  scalar  design  parameter)  becomes  large; 

see  Table  3.1.  This  is  indicated  by  the  fact  that  surfaces 

od  constant  likelihood,  planar  ellipses  in  the  two-dimensional 

2 

case,  contain  less  area  as  q  increase  where  the  area  is 

directly  proportional:  to  the  product  of  the  eigenvalues  of  the 

steady-state  covariance  matrix,  P  (Ref  9) .  (A  quick  check, 

applicable  in  the  two  dimensional  case,  is  to  compute  the 

2 

value  of  P;qP22  ~  P12  s;*-nce  this  value  is  the  magnitude  of 

the  two  eigenvalues  of  P  multiplied  together.  Note,  in  all 

2 

cases  presented  here,  the  P12  is  a  negligible  term  and  thus 

only  values -for  and  P22  are  given  in  the  tables  that 

follow.)  By  examining  Table  3.1,  Doyle  and  Stein's  claim 

that  their  method  moves  some  of  the  filter  poles  toward  stable 

•  2 

plant  zeros  and  the  rest  to  -»  (asymptotically  as  q  becomes 
larger)  can  be  verified. 

Note  that  the  Apollo  model  used  in  Table  3.1  includes  a 
damping  factor,  x, ,  of  0.001  in  the  bending  mode  dynamics 
(i.e.,  the  3,  3  term  in  the  F  matrix  of  Eq  (2.75)  is  no  longer 
0  but  becomes  -2£w  )  .  A  damping  factor  was  added  because  no 
noticeable  performance  improvement  could  be  obtained  with 
;=  0  (which  places  a  set  of  poles  for  the  bending  mode  dynamics 

on  the  imaginary  axis)  and  it  was  anticipated  that  moving  the 
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(1000)*  1.46  108  -288 


CM 

VO 


CM 

VO 


CM 

o 


r 


Table  3.1  (Cont) 


is  the  Doyle  and  Stein  scalar  design  parameter. 


poles  away  from  the  imaginary  axis  might  allow  the  Doyle  and 
Stein  technique  some  extra  "maneuvering  room"  in  which  to 
bring  about  steady  state  performance  improvement.  Several 
damping  factors  between  0.001  and  0.15  were  tried  to  see  if 
steady  state  performance  could  be  improved  but  no  noticeable 
improvement  was  obtained  for  any  value  tried.  (No  values 

41 

larger  than  0.15  were  tried  since  £=  0.15  is  already  10  times 

larger  than  that  in  the  actual  Apollo  system.) 

Table  3.1  shows  only  marginal  improvements  in  closed-loop 

2 

stability  for  the  Apollo  model  as  q  increases  until  some 

2  2 

critical  value  is  reached  (approximately,  q  =  (701)  )  at  which 

closed-loop  stability  is  lost.  Note  that  one  of  the  filter 

2  2 

poles  is  positive  for  q  <_  (701)  ,  the  stable  closed-loop 
system  case,  and  that  the  filter  poles  do  not  migrate  as  Doyle 
and  Stein  suggest  but  abruptly,  at  q  >  (701) change  to  the 
configuration  where  some  are  co-located  with  system  zeros  and 
the  rest  have  larger  negative  real  parts.  At  this  point 
closed-loop  system  stability  is  lost.  It  is  ."noted  that  in  the 
case  of  the  Apollo  model,  the  Doyle  and  Stein  techniques  adds 
white  noise  in  the  system  before  the  first  order  lag  (where 
noise  did  not  previously  enter)  instead  of  after  it  and  this 
may  affect  the  resulting  performance  of  this  technique.  This 
phenomenon  should  be  investigated  further. 

Table  3.2  presents  the  results  for  Test  Cases  2  and  3 
when  the  strength  of  the  continuous-time  noise  Q  is  "tuned" 
by  adding  a  AQ  which  is  a  simple  scalar  multiple  of  Q.  AQ  is 


Table  3.2 


Steady-State  Performance  of 
Continuous-Time  Controllers  with' Tuning 
of  Q  by  Adding  A} 


Test 

Gase 

Q,  4Q 

Steady-State 

Filter 

Poles 

P 

xtxt 

p 

uu 

2 

10,  1 

4 . 4  ( 10 ) ~5 ,  6  .1  (10) — 3 

2.3 

-9.6±j9.1 

2 

10,  100 

2 . 9  ( 10 ) ~5 ,  5 .0 (10) ~3 

5.0 

-40±j40 

2 

10,  1000 

1 . 9  ( 10 ) ~  5 ,  4 . 7 ( 1 0 ) ~3 

79.6 

-125±jl25 

3 

1,  .1 

219  ,  2091 

4  ..3  (10)  4 

-.7 . 2  5±  j  1 . 7 

3 

1,  1 

210  ,  2229  . 

6.5  (10)4 

-11.3,  -6.6 

3 

1,  100 

179  ,  2784 

6.7(10) 5 

-90,  -5.9 

3 

1,  1000 

173  ,  2914 

7(10)  6 

-9000 ,  -5.8 

_______ 

3b 

1,  10 

OO  CO 

oc 

-28.0,  -5.99 

•  3b 

1,  10000 

CO  OO 

•oc 

-900,  -5.90 

3b 

1,  ( 10 ) 6 

OO  OO 

oc 

-9000,  -5.90 

a)  Only  diagonal  terms  P^,  P22  shown. 

b)  Truth  model  F  matrix  deliberately  mismatched  with  controller 

design  model;  F  =  -100.  Test  Case  2  not  shown;  it  also 

z2 , 2 

could  not  be  stabilized  using  this  tuning  procedure. 


chosen  such  that  it  approximates  the  value  of  noise  added  by 
the  Doyle  and  Stein  method.  Tuning  Q  in  this  manner  adds  noise 
at  the  points. of  entry  of  w  into  the  system  dynamics  instead 
of  at  the  point  where  u  enters  as  in  the  Doyle  and  Stein 
technique.  (Test  Case  1  is  not  displayed  because  there  is  no 
physical  difference  between  the  Doyle  and  Stein  technique 
and  this  tuning  procedure  for  this  case.)  Comparing  the  results 
for  Test  Cases  2  and  3  shows  that  there  is  not  much  improvement 
from  one  method  to  the  other  for  Test  Case  2,  but  that  there 
is  a  noticeable  difference  for  Test  Case  3.  Note,  when  the 
closed-loop  system  of  Test  Case  2  was  made  unstable  (by 
changing  entries  for  the  F  matrix)  in  order  to  show  robustness 
effects,  that  neither  procedure  (Doyle  and  Stein  or  adding  AQ) 
could  re-stabilize  the  closed-loop  system.  For  Test  Case  3, 
the  Doyle  and  Stein  technique  gives  better  results  in  the  sense 
that  the  surfaces  of  constant  likelihood,  contain  less  area 
indicating  that  density  functions  are  more  tightly  packed  around 
the  mean  values.  This  approach  was  not  applied  to  the  Apollo 
model  since  the  results  of  the  Doyle  and  Stein  approach  were 
poor . 

As  far  as  the  Test  Cases  are  concerned,  the  Doyle  and  Stein 
technique  appears  to  be  a  valid  approach  to  improving  the 

2 

performance  of  continuous-time  systems  even  for  values  of  q 
less  than  <*.  For  Test  Case  3  this  technique  is  superior  to 
tuning  the  Q  matrix  by  adding  a  AQ  as  a  simple  scalar  multiple 
of  Q.  In  this  case,  the  tuning  procedure  adds  noise  in  both 


state  equations,  but  the  Doyle  and  Stein  technique  adds  noise 

only  to  the  second  state  equation,  where  the  control  input 

exists.  In  contrast,  either  procedure  adds  noise  at  the 

control  input  for  Test  Case  2  due  to  configuration  of  the 

B  and  G  matrices  in  the  test  case.  As  for  the  more  complex 

Apollo  model,  the  results  are  inconclusive.  While  some 

2  2 

marginal  improvement  could  be  seen  for  large  q  and  400, 
the  total  behavior  of  the  system  was  not  as  expected.  In 
particular,  the  "behavior  of  the  filter  poles,  as  discussed 
previously,  was  not  expected,  especially  since  when  the  poles 
were  in  the  desired  positions,  closed-loop  stability  was  lost. 

Discretized  Continuous-Time  Controller 

The  results  of  discretizing  each  controller  without  first 
applying  thd-  Doyle  and  Stein  technique  are  presented  in  Table 
D.2  of  Appendix  D.  Examination  of  the  entries  in  this  table 
reveal  that  the  discretization  process  gives  better  results 
for  smaller  sample  periods,  as  expected  since-  the  first  order 
approximations  used  are  valid  for  small  (relative  to  charac¬ 
teristic  times  of  the  basic  system)  sample  periods  (see  the 
Doyle  and  Stein  Technique  in  Discrete-Time  Systems  -  1  in 
Chapter  II) .  Sample  periods  chosen  for  the  robust  versions 
of  these  controllers  were  those  for  which  the  unmodified 
controllers  had  essentially  the  same  steady-state  performance 
as  their  continuous-time  counterparts.  Table  3.3  presents  the 
results  for  the  discretized  controllers  for  Test  Cases  1,  2, 
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Table  3.3  (Cont) 


Test 

Steady-State 

Case 

t 

q2  b 

Px  x  a 

txt 

p.  - 

uu 

lc 

m 

.001 

0 

00 

00 

ic 

.001 

1 

00 

00 

ic 

.001 

100 

12.0 

2.44 

ic 

.001 

(1000) 2 

7.33 

128 

3C 

.001 

0 

00 

CO 

3C 

.001 

.00 

00 

QO 

3C 

.001 

10000 

1025,  554 

4 . 99 (10) 6 

3C 

.001 

(1000) 2 

1533,  262 

2.16 ( 10) 6 

a)  only  diagonal  terms  P^,  ?22  shown. 

b)  q  is  the  Dcyle  and  Stem  scalar  design  parameter. 

c)  F  matrices  changed  in  truth  model  description  to  show 
robustness.  For  Test  Case  1,  F  =  0.1;  for  Test  Case  3 
F  =  -100.  Test  Case  2  could  not  be  stabilized  once  a 

t2 , 2 

destabilizing  F  was  chosen. 


r 
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and  3  when  the  Doyle  and  Stein  technique  is  applied.  Comparing 

the  results  for  Test  Cases  1,  2,  and  3  shown  in  Table  D.2  and 

3.3  shows  that  discretizing  a  continuous-time  controller  to 

which  the  Doyle  and  Stein  technique  has  been  applied  produces  a 

discrete-time  controller  with  enhanced  performance  up  to  a 

2 

certain  value  of  q  . 

The  Apollo  model  presented  difficulties  in  this  case 
also.  In  fact,  no  matter  how  small  the  sample  time  was  made 
(periods  down  to  0.001  sec  were  investigated),  the  resulting 
closed-loop  system  was  unstable  indicating  that  the  first 
order  approximations  were  invalid.  To  improve  the  situation, 
a  damping  factor  was  again  added  in  bending  mode  dynamics  as 
in  the  continuous-time  case.  The  initial  choise  of  £=  0.015 

and  sample  periods  _<0.01  sec  allowed  the  resulting  discretized 

-  2 
continuous-time  controllers  to  remain  stable  even  though 

was  varied  passed  400  which  was  the  desired  value  about  which 

to  investigate  performance .  By  trial  and  error  and  noticing 

trends  in  the  data  (the  interactive  computer .program  was  well 

suited  to  this  task)  a  suitable  combination  of  sample  period  and 

damping  ratio  was  found.  With  a  £=  0.01  and  sample  period 

of  0.01  sec,  a  discretized  continuous-time  controller  that 

2 

was  initially  unstable  at  1^=  400  could  be  made  stable  by 

applying  the  Doyle  and  Stein  technique  before  discretizing. 

Values  of  q^  between  (100) ^  and  (0.001) ^  were  tried  and 
2  2 

q  =  (0.02)  selected  as  the  value  that  gave  the  best  performance 
In  fact  stable  closed-loop  operation  occurs  only  for 


7  r**K**ti*&f**  ~  - — 
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(0.005)2  _f_  <_  (0.05)2.  Tfte  fact  that  there  is  an  upper 

limit  on  the  value  for  q  is  an  aspect  that  is  not  seen  in 
the  continuous-time  case.  Fig  3.3  shows  the  performance  of 
the  unstable  unmodified  discretized  continuous-time  controller. 
Figs  3.4  and  3.5a  show  the  performance  of  the  discretized 

controller  after  the  Doyle  and  Stein  technique  is  applied 

2  2  2  2 

where  q  =  (0.1)  .  For  q  =  (0.02)  the  results  are  shown  in 

Figs  3.5b  and  3.6.  It  is  quite  evident  from  these  Figs  that 
applying  the  Doyle  and  Stein  technique  can  cause  dramatic 
improvements  in  performance. 

Thus,  applying  the  Doyle  and  Stein  to  a  continuous¬ 
time  controller  and  then  discretizing  the  result  to  produce 
a  robust  discrete-time  controller,  appears  to  be  one  acceptable 
approach  to  extending  the  Doyle  and  Stein  technique  to  discrete¬ 
time  controllers.  Note  however,  that  since  the  discretization 
process  requires  appropriately  small  sample-times,  it  is 
anticipated  that  there  will  be  some  cases  where  this  technique 
cannot  be  applied  readily.  The  Apollo  model  'is  a  good  example 
of  this  since  in  the  actual  Apollo  system  the  sample  period 
is  3.1  secs  which  is  10  times  slower  than  that  which  produces 
a  stable  closed-loop  system.  One  other  item  to  note  at  this 
point  is  that  the  interactive  computer  program  is  well  suited 
to  any  tuning  (trial  and  error)  that  may  be  required.  In  fact, 
the  author  accomplished  the  tuning  described  above  in  several 
hours  of  interactive  computer-time,  whereas  it  probably  would 
have  taken  several  days  using  batch  processing. 
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variance  of  state  1  d)  variance  of  state  i 

,  6  Discretized  continuous -time  performance  with  o/2=400  and  q2=0.0004 


Sampled-Data  Controllers 


This  section  presents  the  results  and  conclusions 

concerning  the  *performance  of  the  robust  sampled-data  controllers 

developed  in  this  thesis.  A  discussion  in  the  effect  of 

applying  the  Doyle  and  Stein  technique  (as  extended  in  the 

Enhancing  Robustness  of  Discrete-Time  Controllers  -  2^  section 

of  Chapter  II)  appears  first,  followed  by  comparison  with  the 

effects  of  tuning  the  Q  matrix  (by  adding  a  AQ  as  in  the 

continuous-time  discussion) .  Last  there  is  a  discussion  of 

the  results  for  picking  the  Kalman  filter  gair^K,  directly 

(see  appropriate  section  of  Chapter  II) . 

Doyle  and  Stein  Techniques  Extended  to  Sanrpled-Data 

Controllers .  The  steady-state  performance  of  the  sampled- 

data  controllers  for  Test  Cases  1,  2,  and  3,  with  no  robustness 

enhancement J"  is  shown  in  Table  D.3  of  Appendix  D.  Note  here 

that,  as  for  discretized  continuous-time  controllers,  the 

sample  period  can  greatly  affect  the  steady-state  performance. 

The  performance  of  the  sampled-data  controller  for  the  Apollo 

model,  with  no  robustness  enhancement  and  for  several  different 
o 

values  of  is  presented  in  Figs  3.7  and  3.8  and  Figs  F.4 

through  F.6  of  Appendix  F.  As  in  the  continuous-time  case, 

2 

the  closed-loop  system  is  unstable  for  co^  <_  50  (although  this 

is  not  shown  in  the  above  Figs) .  In  the  sampled-data  case 

2 

instability  also  occurs  when  >•  200.  (Note  0.1  secs  is  the 
chosen  sample  period  for  the  Apollo  model  since  this  value 
gives  good  performance  and  is  the  same  as  that  used  in  the 
actual  Apollo  controller) . 


73 


The  steady  state  closed-loop  performance  with  the  Doyle 

and  Stein  technique  applied  is  presented  in  Table  3.4  for  Test 

Cases  1,  2,  and*- 3  and  in  Figs  3.9,  3.10,  and  F.7  through  F.10 

for  the  Apollo  model.  Comparison  of  the  results  presented  in 

Tables  3.3  and  3.4  shows,  for  Test  Cases  1,  2,  and  3,  that  the 

o 

steady  state  performance  is  enhanced  as  q  increases  in  the 

stnse  that  areas  of  the  ellipse  representing  the  surfaces  of 

constant  likelihood  become  smaller  (see  related  discussion  of 

these  surfaces  in  the  Continuous-Time  Controller  section  of  this 

chapter).  For  the  Apollo  model  the  results  are  similar.  Figs 

3.9  and  3.10  show  stable  closed-loop  operation  for  10^=  400 

and  700,  respectively,  while  Figs  3.7,  3.8  and  F.6  indicate 

that  the  closed-loop  system  with  an  unmodified  controller  is 
2 

unstable  for  >  300.  By  examining  Figs  3.9,  F.7  and  F.8, 

-  2 

one  can  see_that  there  is  a  value  of  q  (in  this  case  between 

2  2 
(0.1)  and  1.0)  beyond  which  increases  in  q  produce  no 

noticeable  difference. 

As  in  the  continuous-time  case,  a  comparison  is  made 

between  the  Doyle  and  Stein  technique  benefits  and  those  benefits 

obtained  by  tuning  the  Q  matrix  by  adding  a  scalar  multiple 

of  Q,  AQ.  Also  as  in  the  continuous-time  case  AQ  is  chosen  so 

2 

as  to  approximate  values  of  q  used.  When  this  technique  is 
applied  to  Test  Cases  1,  2,  and  3,  the  performance  could  be 
made  similar  to  that  obtained  by  applying  the  Doyle  and  Stein 
technique  as  shown  by  comparing  the  results  in  Tables  3.4  and 
3.5.  In  contrast,  Figs  3.11  and  3.12  show  the  performance 
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Table  3.5 


I* 


Steady-State  Performance  of  Sampled-Data 
Controllers  When  Q  is  Tuned  by  Adding  AQ 
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At 

Q  , 

AQ 

Steady-State 

Pxtxt 

a 

Puu 

1 

.01 

-2  , 

-  1 

1.73 

.156 

1 

.01 

2  ' 
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1.53 

1.97 

2 

.01 

10, 

1 

3.92 (10)“5, 
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2 

.01 
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a)  only  the  diagonal  terms  P^l'  P22  are  s^own 

b)  F  matrices  changed  in  truth  model  descriptions  to  show 
robustness.  For  Test  Case  1,  F.=  .1;  for  Test  Case  3 
F  =  -100.  Test  Case  2  not  snown ,  but  it  could  not 

t2,2 

be  stabilized  using  this  technique  once  a  destabilizing 
F  matrix  was  chosen. 


c)  Steady-state  not  racned  during  length  of  simulation, 
but  eigenvalues  are  within  the  unit  circle. 


of  the  Apollo  system  when  the  Q  and  IQ  tuning  procedure  is 

used.  Note  only  the  mean  of  state  1  and  variance  of  state  4 

are  shown  but_  ail  states  exhibit  similar  behavior.  Note,  from 

Figs  3.11  and  3.12,  that  no  matter  what  value  of  AQ  was  added, 

there  was  little  or  no  performance  benefit.  While  the  largest 

AQ  shown  in  Figs  3.11  and  3.12  is  10,000,  larger  values  were 

tVied  but  the  closed  loop  system  eigenvalues  rapidly  moved 

outside  and  away  from  the  unit  circle  resulting  in  even  more 

unstable  closed 'loop  operation. 

Based  on  the  above  comparisons  and  discussion,  the 

extension  of  the  Doyle  and  Stein  technicrue  to  sampled-data 

systems  provides  a  valuable  tool  for  performance  enhancement 

in  the  face  of  uncertain  parameters  in  the  controller  design 

2 

model.  For  the  Apollo  model,  values  of  q  as  small  as  0.0001 

ef f ectively Jcreated  a  stable  closed-loop  system  as  shown  in 
2 

Fig  F-9.  (For  q  >0.01  the  increase  in  stability  appears  more 

dramatic  at  first  glance.  Figs  3.10  and  F.9,  but  this  is  partly 

2 

due  to  a  much  larger  initial  transient  that  occurs  when  q 
increases.)  Tuning  Q,  by  adding  a  AQ,  that  is  a  scalar 
multiple  of  Q,  had  little  effect  on  the  Apollo  model  since 
this  did  not  add  additional  noise  at  the  control  input  as  the 
Doyle  and  Stein  technique  did. 

Robustness  Enhancement  by  Directly  Picking  K.  In 
general  the  results  from  this  technique  were  unsatisfactory. 

For  Test  Case  2  and  the  Apollo  model,  there  were  no  combinations 
of  the  scalar  design  parameter  q  (see  the  applicable  section  of 
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Chapter  II)  and  sample  period  that  produced  stable  closed- 
loop  systems.  The  results  for  Test  Cases  1  and  3  are  presented 
in  Table  D.3  of1-  Appendix  D.  Test  Case  1  is  the  only  case  used 
in  this  study  for  which  this  technique  provided  performance 
enhancement.  For  Test  Case  3,  using  the  areas  of  the  ellipsoids 

representing  the  surfaces  of  constant  likelihood  as  the  basis 

«• 

of  comparison,  shows  that  the  performance  actually  degraded 
with  increasing  q.  (Recall  that  the  product  of  and  P22  as 

given  in  Table  D.3  is  directly  related  to  these  areas.) 

One  possible  cause  for  the  failure  of  this  technique 
to  produce  stable  closed-loop  systems  is  that  the  suboptimal 

A.  __ 

control  law  u(t^)  =  -G*  x(t^)  was  chosen  as  the  basis  of  the 
controller  instead  of  the  optimal  control  law  u(t^)  =  -G*  x(t^)  . 
The  case  for  the  optimal  control  law  should  be  investigated. 
Another  possibility  is  that  there  is  an  as  yet  undetected 
error  in  software  used  to  implement  this  controller  despite 
thorough  testing  and  validation.  In  any  event  it  is  noted  at 
"this  point  that  there  are  no  stability  guarantees  for  this 
method  of  choosing  K  as  there  are  for  the  LQG  controller  when 
K  is  obtained  as  a  result  of  solving  the  appropriate  matrix 
Riccati  equation  (Eq  C.18  of  Appendix  C  for  example). 

Remarks 

Closed-loop  system  eigenvalues  were  determined  for  each 
control  system  designed  anc  were  the  primary  basis  of  claims 
about  closed-loop  stability.  Although  these  eigenvalues  indicate 


stability,  they  do  not  directly  provide  performance  charac- 
teristics  versus  time  of  each  controlled  system.  This 
information  i-s  ^obtained  from  the  mean  and  covariance  analyses 
developed  in  Chapter  II.  Both  performance  measures  have 
been  presented  here  to  provide  an  adequate  portrayal  of  system 
characteristics . 

Another  item  of  a  general  nature  and  applicable  to  all 
the  modified  controllers,  whether  continuous  or  discrete-time, 
is  that  as  the  noise  level  is  artifically  increased  in  the 
system  (via  Doyle  and  Stein  technique  or  by  tuning  Q  by  adding 
LQ)  the  control  variable  variance  generally  increases  (implying 
increased  control  costs  are  incurred  for  increased  robustness, 
which  is  not  surprising) ,  This  fact  should  be  considered  in 
f  any  design  attempting  to  apply  the  techniques  for  enhancing 

robustness  that  are  discussed  in  this  thesis. 

One  final  note  involves  the  performance  of  Test  Case  2. 
This  system  did  not  behave  "nicely"  during  the  course  of  this 
investigation.  It  could  not  be  made  stable  when  picking  the 
Kalman  filter  gain  directly  and  it  could  not  be  stabilized 
(using  either  of  the  two  procedures  tried  here)  once  the  F 
matrix  was  changed  to  destabilize  the  closed-loop  system  for 
robustness  studies.  The  performance  of  this  Test  Case  should 
be  investigated  further  and  characterized. 
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IV  Recommendations 


The  recommendations  fall  into  two  main  categories.  The 
first  deals  with  the  basic  nature  of  robust  control  systems 
and  the  second  deals  primarily  with  increasing  the  utility  of 
the  interactive  computer  program  developed  to  support  this 
s*tudy . 

Basic  Investigation 

The  first  item  that  requires  further  investigation 
and  explanation  is  the  fact  that  the  Doyle  and  Stein  technique 
did  not  provide  noticeable  performance  enhancement  for  .the 
continuous-time  Apollo  system.  There. are  two  aspects  about 
this  particular  model  that  may  have  affected  the  results.  The 
first  is  that  there  is  no  damping  in  the  bending  mode  dynamics, 
which  places  a  pair  of  poles  on  the  imaginary  axis.  An 
attempt  to  allow  the  Doyle  and  Stein  technique  more  "maneuvering 
room"  by  moving  these  poles  off  the  imaginary  axis  (non-zero 
damping  factor)  was  tried  but  was  not  successful.  The  second 
is  that  for  the  unmodified  continuous-time  controller,  noise 
enters  only  states  2  through  5  but  when  the  Doyle  and  Stein 
technique  is  used,  noise  now  enters  before  the  first  order 
deterministic  lag  and  thus  into  all  5  states.  The  effects  of 
this  aspect  on  the  Doyle  and  Stein  technique  need  to  be 
characterized . 

A  second  item  is  that,  for  Test  Case  3,  one  of  the 
LQG  controller  poles  (eigenvalues  of  F  -  B  G*  -  K  H) 


is  positive  but  the  closed-loop  poles  are  all  negative  and 


thus  the  closed-loop  system  is  stable.  This  phenomenon  has 
been  observed. btef ore  by  C.D.  Johnson  ("State-variable  Design 
Methods  May  Produce  Unstable  Feedback  Controllers",  Inter¬ 
national  Journal  of  Control ,  1979,  Vol  29,  No.  4,  607-619) 
and  should  be  investigated  and  characterized.  Another  phenomenon 
that  should  be  investigated  is  the  fact  that  there  are  upper 
limiting  values  on  q  (in  the  Doyle  and  Stein  technique)  beyond 
which  the  discretized  continuous-time  and  sampled-data  controllers 
no  longer  cause  closed-loop  system  stability,  something  not 
observed  for  the  purely  continuous-time  case. 

The  results  for  picking  K  directly  were  unsatisfactory 

and  this  approach  whould  be  investigated  further.  The 

investigation  should  include  the  possibility  of  using  the  optimal 

control  law„u(t.)=  -G*  x(t.)  as  the  basis  of  the  formulation. 

—  i  — c  —  i 

As  mentioned  previously,  there  are  no  guarantees  of  closed- 
loop  stability  (even  with  no  mismatch  between  the  design  and 
truth  models)  when  this  method  is  used,  unlik’e  the  case  of 
using  the  optimal  gains  from  LQG  controller  synthesis  methods 
(when  there  is  no  mismatch  of  design  and  truth  models) . 

For  the  cases  where  good  results  were  obtained,  exten¬ 
sions  should  be  attempted.  The  possibility  of  adding  time- 
correlated  noise  in  a  fashion  similar  to  that  of  Doyle  and  Stein's 
technique  for  adding  white  noise  should  be  investigated.  The 
results  would  have  potential  applications  in  cases  where  the 
noise  process  is  known  to  be  frequency  limited.  Thus  the 
controller  would  only  expend  extra  control  energy  over  a 
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specific  frequency  bandwidth  to  achieve  robustness  instead  of 
over  the  entire  frequency  spectrum  as  is  the  case  for  white  noise 
In  addition,  the  results  of  extending  these  techniques  to  a 
more  general  purpose  controller,  (as  opposed  to  the  simple 
regulator  used  here)  such  as  a  Command  Tracker  Generator/ 
Proportional  Plus  Integral  Plus  Filter  Controller,  should  be 
investigated  (Ref  10) .  Also  the  performance  benefits  for  other 
specific  applications,  such  as  in  aircraft  flight  control  systems 
should  be  investigated. 

Program  Improvements 

Since  the  program  is  interactive  and  the  CYBER  remote 
terminals  limit  the  amount  of  memory  that  can  be  used  at  AFIT, 
the  size  of  the  systems  that  the  program  can  currently  handle 
is  restricted  to  less  than  eighth  order  systems.  Two  approaches 
can  be  taken  to  alleviate  this  problem.  One  would  be  to  rework 
the  current  interactive  program  to  use  several  of  many 
available  techniques  to  streamline/optimize  the  source  code 
so  as  to  reduce  core  memory  requirements.  Use  of  FORTRAN 
overlay  structure,  reworking  the  system  model  storage  in 
conjunction  with  limiting  the  allowable  number  of  inputs  and 
outputs  are  several  of  the  potential  techniques  that  could  be 
ued.  (See  Appendix  C.)  A  second  approach  would  be  to  produce 
a  non-interactive  version  to  handle  high  order  systems. 

There  are  several  ether  items  that  could  be  changed 
and/or  added  to  make  the  program  more  useful.  One  is  to 
provide  a  better  discretization  technique  for  producing  the 
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discretized  continuous-time  controller  in  order  tc  remove  some 
l  of  the  negative  effects  that  the  discretization  process  has  on 

controller  performance  when  the  assumption  used  in  the  first 
order  approximation  (small  sample  period  compared  to  system 
characteristic  times)  is  not  valid.  A  potentially  useful  option 
would  be  to  provide  plots  of  the  time  histories  of  the  mean 
tracking  errors  versus  just  plotting  the  means  of  the  states. 

This  could  be  accomplished  relatively  easily  since  the  perfor¬ 
mance  analysis  software  currently  propagates  the  state  estimates; 
it  just  does  not  store  them  for  plotting.  Note  this  would  be 
useful  in  making  comparisons  with  data  available  in  the 
literature  since  tracking  error  data  is  used  .widely  for.  compar¬ 
isons.  Another  potentially  useful  option  would  be  to  provide 
time  histories  of  the  sampled-data  mean  and  covariance  between 
sample-time  “which  would  provide  additional  insight  into  system 
performance.  The  current  time  history  data  provides  no 
information  about  system  behavior  between  sample  periods  and 
thus  the  possibility  of  aliasing  errors  exist's.  Finally,  an 
option  to  compute  the  eigenvalues  of  the  steady-state  covariance 

matrix,  P  ,  would  be  useful  in  evaluating  the  closed-loop 
xtxt 

system  performance  of  various  controllers  as  design  parameters 
are  changed  since  they  are  directly  related  to  the  areas  of 
the  surfaces  of  constant  likelihood. 
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Appendix  A 
Software  Flowcharts 

This  appendix  contains  flowcharts  of  the  software 
developed  during  the  course  of  this  thesis.  In  this  appendix, 
acronyms  such  as  1QGR?,  ChPTR  and  DDTCOK  are  the  subroutine 
names  as  they  appear  in  the  FORTRAN  source  code.  When  these 
acronyms  appear  beneath  the  lower  right  corner  of  a  block  in 
the  flowchart,  this  indicates  that  the  functions  in  that  box 
are  performed  by  the'given  subroutines.  All  such  subroutines 
have  their  own  flowcharts  and  descriptions.  Flowcharts  begin 
with  a  subroutine  or  program  name  and  end  with  a  return,  end 
or  stop.  Each  subroutine  description  has  a  reference  to  the 
corresponding  flowchart  number  in  parentheses  next  to  the 
subroutine  title. 

LQGRF  (Fig  A . 1 ) 

LQGRF  is  the  main  program  name.  IQGRF  sequences  the 
.three  primary  program  modes.  The  first  primary  mode  is  for 
input.  .-.11  matrices/vectors  associated  with  the  controller 
model  and  truth  model  are  entered  when  LQGRF  is  in  xhe  input 
mode.  The  second  primary  mode  develops  and  formats  for  per¬ 
formance  analysis,  either  a  continuous-time  or  sampled-data 
controller  depending  on  a  user  input.  The  last  primary  mode 
in  LQGRF  is  the  performance  analysis.  The  performance  analy¬ 
sis  is  a  covariance  analysis  as  described  in  the  body  of  the 
thesis  for  continuous-time  and  sampled-data  systems. 


INFUTK  (Fig  A.  2) 

The  subroutine  INFUTK,  the  first  primary  mode  of  LQGF.F, 
allows  the  usert  to  input  or  output  system  model  matrices  for 
the  truth  model  and  controller  model.  In  addition,  it  allows 
the  user  to  specify  cost-we ighting  matrices  needed  for  optimal 
LQG  controller  computation.  The  subroutine  INPUTM  is  entered 
4t  the  beginning  of  each  simulation  run.  Each  time  it  is  en¬ 
tered,  the  user  can  select  to  change  and/or  print  any,  all 
or  none  of  the  aatriees  or  portions  of  any  or  all  matrices 
by  choosing  appropriate  options.  One  set  of  options  specifies 
a  particular-  matrix  or  vector,  the  other  set  specifies  what 
to  do  with  that  matrix  or  vector.  The  options  are  listed  in 
Table  E.l  of  Appendix  E. 

Two  additional  options  in  this  routine  allow  the  user 
to  store  ail  matrices,  and  subsequently  retrieve  them  from  a 
local  file  that  can  be  stored  as  a  permanent  file  upon  program 
termination.  This  option  is  especially  useful  for  systems 
.of  large  dimension  that  will  be  used  during  many  different 
sessions  of  running  the  program.  The  user  merely  has  to  at¬ 
tach  the  permanent  file  created  during  a  previous  run  and 
execute  one  option  to  recover  the  entire  set  system  matrices. 
Normal  program  termination  can  only  be  accomplished  when  in 
the  input  mode.  Program,  termination  is  accomplished  by  spec¬ 
ifying  any  r.atrix/vector  option  and  then  specifying  an  input/' 
output  option  of  zero. 
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RGS  (Fig  A. 3) 


The  subroutine  RGS,  directs  the  development  and 
formatting  of  LQG  controllers  for  performance  analysis  by 
subroutine  PERFAL.  Based  on  a  user  input. to  select  either 
a  continuous- time ,  discretized  continuous-time  or  a 
sampled-data  LQG  regulator,  RGS  calls  the  appropriate 
Subroutines  CLQGRS  or  DLQGRS  necessary  to  compute  the 
various  quantities  associated  with  each  type  controller. 

After  the  desired  controller  is  properly  formatted,  RGS 
calls  subroutine  FRMAUG  to  form  the  augmented  system 
matrices  as  described  in  the  performance  analysis  sections 
of  this  thesis.  Eigenvalues  of  the  closed-loop  system  _are 
computed  (See  subroutine  MEIGN)  if  the  user  wants  to  see  them. 

PERFAL  (Fig ~A. 4) 

The  subroutine  PERFAL  performs  the  performance  analysis 
as  described  in  both  performance  analysis  sections  of  this 
thesis.  PERFAL  uses  the  flag,  IFLGSD,  which ‘is  set  in  the 
subroutine  RGS,  to  determine  whether  to  perform  a  continuous¬ 
time  or  discrete-time  system  performance  analysis. 

CLQGRS  (Fig  A. 5) 

The  subroutine  CLQGRS,  called  by  RGS,  performs  the 
computations  to  specify  a  continuous-time  LQG  regulator 
anc  format  it  for  performance  analysis.  CLQGRS  calls  sub¬ 
routine  CKFTR  to  calculate  steady-state  Kalman  filter  gain 
K,  and  calls  CDTCON  to  compute  the  optimal  steady-state 


98 


lU 


feedback  gain  matrix,  G  *  .  Eigenvalues  of  the  truth  model  F 
matrix,  the  controller  model  F  matrix,  [F^  -  Kf  Hf]  (filter 
poles) ,  [Ff  Ff  G*]  (LQ  controller  poles)  and  [F^  -  Bf  G*  - 
H^]  (LQG  controller  poles)  are  calculated  if  the  user  wants 
to  see  them  (MEIGN) . 

MEIGN  (Fig  A. 6) 

- 

The  subroutine  MEIGN  is  called  by  CLQGRS  to  compute 
and  then  print  the  eigenvalues  of  any  given  square  matrix. 

CKFTR  (Fig  A. 7) 

The  subroutine  CKFTR  is  called  by  CLQGRS  to  perform 
the  computations  for  determining  the  steady- state  continuous¬ 
time  Kalman  filter  gain  K  as  in  Eq  (2.13).  This  subroutine 
deletes  deterministic  states  from  the  filter  equations  as 
described  ip  the  Deterministic  State  Augmentation  section 
of  this  thesis.  In  addition,  the  user  may  select  to  use 
the  Doyle  and  Stein  method  to  enhance  robustness  of  the 
controller.  This  is  done  through  a  call  to  subroutine  DASl. 

DAS1  (Fig  A. 8) 

The  subroutine  DASl,  when  called  by  CKFTR,  gives  the 
user  the  necessary  design  options  to  perform  modifications  to 
the  Kalman  filter  gain  calculations  that  are  described  in  the 
Enhancing  Robustness  in  Continuous -Time  LQG  Controllers  section 
of  this  thesis.  The  user  selects  the  scalar  design  parameter, 
q,  and  the  matrix  design  parameter,  V,  and  then  must  select 
to  calculate  the  modified  Q(q)  matrix.  After  observing  the 
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modified  Q(q)  matrix  the  user  can  select  either  to  exit  the 
routine  or  recalculate  Q(q)  with  new  parameters.  Note,  the 
user  may  chose  vany  option  at  any  time  in  this  routine  ana 
therefore  must  insure  that  values  are  chosen  for  q  and  V 
prior  to  calculating  G(q)  and  that  Q(q)  is  calculated  prior 
to  leaving  the  routine. 

« 

CDTCON  (Fig  A. 9) 

The  subroutine  CDTCON  is  called  by  CLQGRS  to  perform 
the  necessary  calculations  to  obtain  the  continuous-time  op¬ 
timal  steady-state  feedback  gain  matrix,  G*  as  described  by 
Eqs  (2.10)  and  (2.14).  This  subroutine  makes  provision  for 
non-zero  cross  cost-weighting  matrices  by  calling  the  sub¬ 
routine  PRIMIT.  PRIMIT  supplies  an  equivalent  transformed  sy¬ 
stem  of  equations  in  which  the  cross  cost-weighting  terms  are 
zero.  This  transformation  is  necessary  because  the  matrix 
Riccati  solver  can  handle  only  those  systems  of  equations 
.with  zero  cross  cost-weighting  matrices.  A  discussion  of  the 
transformation  is  in  Appendix  C. 

KIYIKTG  (Fig  A.  10) 

The  subroutine  MYINTG  is  called  by  RGS  and  DLQGRS . 

It  provides  an  equivalent  discrete -time  representation  of 
any  given  set  of  F,  B,  G  and  Q  matrices.  That  is,  it  computes 
and  returns  th0  state  transition  matrix  $  based  on  F.  It 
computes  and  returns  0^,  the  discrete-time  representation  of 
which  is  an  integral  function  of  i,  G  and  Q.  In  addition, 
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it  computes  and  returns  ,  which  is  a  function  of  B  and  the 
integral  of  i.  See  Fig  A. 10  for  the  equations  used  in  this 
calculation. 

DSCRTZ  (Fig  A. 11) 

The  subroutine  DSCRTZ  takes  an  appropriately  formatted 
(^rom  CIQGRS)  continuous -time  LQG  controller  and  discretizes 
it  using  the  first  order  approximations  described  in  the 
Doyle  and  Stein -Technique  in  Discrete-Time  Systems  -  ^1  section 
of  this  thesis.  These  approximations  are  then  properly  format 
ted  for  the  performance  analysis  routine.  In  addition,  this 
subroutine  computes  and  then  formats  for  performance  analysis, 
an  equivalent  discrete-time  truth  model  and,  if  appropriate, 
the  discrete -time  approximation  R^=  R.c j&X  where  at  is  the 
sample  time  .and  R^  is  the  discrete-time  approximation  to  Rc , 
the  strength  of  the  continuous-time  measurement  noise  (Ref  10) 

DLQGRS  (Fig  A. 12) 

The  subroutine  DLQGRS  is  called  by  RGS  to  perform  all 
necessary  computations  to  specify  a  sampled-data  controller 
and  then  formats  the  controller  for  performance  analysis  as 
discussed  in  the  Samplea-Data  LQG  Controller  section  of  this 
thesis.  DLQGRS  calls  XSU  and  then  DDTCON  to  compute  the 
steady-state  optimal  feedback  gain  matrix  G* .  It  then  com¬ 
putes  a  steady-state  Kalman  filter  gain  K,  using  the  subrou¬ 
tine  DKFTR  or  the  subroutine  PKDIRC  depending  on  whether  the 
user  wishes  to  compute  K  from  the  matrix  Riccati  equation 
(DKFTR)  or  to  pick  K  directly  (PKDIRC)  (as  in  the  section 
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Fig  A. 12  DLQGRS 


User  selects 


r.exhoa  of  obtaining  Kalr.an  filter  gain 


■f  ;-2s 1 r  * 


••-■*»»».  ./■  v-**r  ■ii 
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of  this  thesis  titled  Enhancing  Robustness  of  Discrete-Time 
Systems  by  Directly  Choosing  K.)  Filter  poles,  LQ  controller 
poles  and  LQG  controller  poles  are  calculated  (MEIGN)  if  the 
user  wants  to  see  them. 


XSU  (Fig  A. 13) 

«  The  subroutine  XSU  is  called  by  DLQGRS  to  compute 

the  matrices  X(t^) /  S(t^)  and  U(t^)  as  described  in  Eqs  (2.95) 
through  (2 . 97) . ~  Note ,  XSU  does  not  directly  solve  Eq  (2.95) 
through  (2.97)  but  solves  an  approximation  to  their  solution 
forms  as  discussed  in  Appendix  C,  Programming  Considerations . 

DDTCON  (Fig  A. 14) 

The  subroutine  DDTCON  is  called  by  DLQGRS  to  compute 
the  steady  state  optimal  feedback  gain  matrix,  G*,  for  a 
sampled  data  controller.  Some  data  formatting  complexities 
involved  in  using  Kleinman 1 s  matrix  Riccati  equation  solver 
to  compute  the  G*  are  discussed  in  detail  in  Appendix  C. 

One  involves  computing  values  for  the  integral  definitions 
of  X,  ^S  and  U  as  described  in  the  Sampled-Data  Controller 
section  of  this  thesis  (See  subroutine  XSU) .  Another  involves 
converting  a  system  with  a  non-zero  cross  cost-weighting 
matrix,  S,  to  an  equivalent  one  with  a  zero  cross  cost¬ 
weighting  term  since  the  Kleinman  matrix  Riccati  solver  does 
not  have  provisions  for  non-zero  S  (this  conversion  is  done 
by  subroutine  PRIMIT) . 


DKFTR  (Fig  A.15) 

The  subroutine  DKFTR,  when  called  by  DIQC-RS ,  computes 
the  steady-state  Kalman  filter  gain,  K,  for  a  sampled-data 
LQG  regulator  as  discussed  in  the  Samoled-Data  LQG  Controller 
section  of  this  thesis.  There  is  a  provision  to  modify  the 
computed  value  of  K  by  altering  0^  (the  covariance  on  input 
rfoise  matrix)  that  appears  in  the  matrix  Riccati  equation  for 
K.  The  modification  is  performed,  when  requested  by  the  user, 
by  calling  subrouting  DAS2 . 

DAS 2  (Fig  A. 16) 

The  subroutine  DAS2,  when  called  by  DKFTR,  performs  a 
modification  to  0^  (the  covariance  of  the  input  noise)  that 
is  a  modification  to  the  Doyle  and  Stein  technique  that  is 
applicable  to  sampled-data  systems.  See  section  The  1 oyle 
and  Stein  Technique  in  Discrete-Time  Systems  -  2  in  the  body 
of  this  thesis,  for  a  description  of  this  modification.  DAS2 
•is  very  similar  to  DAS1  and  as  in  DAS1,  the  user  chooses  op¬ 
tions  in  order  to  enter  a  scalar  design  parameter,  to  enter 
a  matrix  design  parameter,  to  calculate  the  modified  and 
to  exit  the  routine. 

PKDIRC  (Fig  A. 17) 

The  subroutine  PKDIRC,  when  called  by  DIQC-RS ,  performs 
the  necessary  input  options  and  computations  to  derive  a  Kal¬ 
man  filter  gain  K  in  the  manner  described  in  the  Enhancing 
Robustness  of  Discrete-Time  Systems  by  Directly  Choosing  K 
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Read  optioft 
1,  2k,  2B,  3,  4 


_ I _ 

1-Enter  scalar  design 
parameter,  q 

2A-Enter  matrix  design 
parameter  W 

2B-Compute  matrix  design 
parameter 

3- Compute  and  print  steady- 
state  K=q5.“*BjVJ 

4- Exit  this  routine 


section  of  this  thesis.  The  user  rr.ust  specify  the  scalar 
\  design  parameter,  q,  and  one  of  tv;o  methods  for  choosing  the 

matrix  design  parameter,  W.  W  can  either  be  chosen  directly 
or  can  be  calculated  as  in  Eq  (2.129). 


s 


% 


PRMAUG  (Fig  A. 18) 

«■  The  subroutine  FRMAUG  receives  data  in  either  the  con¬ 

tinuous-time  or  sampled-data  LQG  controller  format  and  forms 
the  augmented  matrices  required  by  the  performance  analysis 
algorithms  described  in  both  the  Continuous -Time  Performance 
Analysis  and  the  Sampled -Data  Performance  Analysis  sections 
of  this  thesis.  That  is,  it  forms  F.  or  3*  ,  B„  or  B,-,  G„  or 
G^„ ,  or  Q.daj  and  £x  v  continuous-time  systems. 

In  addition,  it  also  forms  R  .  G„„_,  G,,_  .  R  and  G„„0  are 

a  CZd  Uci  3.  *"CZci 

simply  R.  apd  G__  in  the  upper  left  partitions  of  R_  and  C-  „„ 

X  C  Zi  *  cl  C  it  c- 

respectively.  All  other  elements  in  R  and  G^„0  are  zero. 

a  c  z»  a 

It  is  necessary  to  form  R.  and  G„„_  in  order  to  use  the  Klein- 

a  c  z  a  , 

man  matrix  routines  which  require  that  all  matrix  arguments 

be  of  the  same  declared  dimension.  G  _  is  formed  out  of  ex- 

ua 

peaiency.  It  is  the  lower  partition  of  the  matrix. 


G  H. 
— cz  — t 


-cz 


which  appears  in  Eqs  (2.47),  (2.49)  and  (2.50).  With  G 

ua 
~T 


defined,  =  G  P  _ 

— uu  -ua  — x  x„  -ua 
a  a 


This  eliminates  the  un¬ 
necessary  multiplications  associated  with  the  upper  partition 
of  the  matrix  above. 
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Note  that  P  as  defined  m  Eq  (2.57)  is  calculated 

— x  v^  ^ 

a  t 

only  for  continuous-time  systems  and  then  only  when  Gcz  in 
Eq  (2.27A)  is  not  equal  to  zero. 

STORED  (Fig  A. 19) 

The  subroutine  STORED  is  called  by  PERFAL  to  format 
deta  from  the  performance  analysis  subroutine,  PERFAL,  for 
storage  on  local  files.  This  allows  the  user  to  store  data 
as  a  permanent  file  upon  program  termination  and,  later, 
to  recall  the  permanent  files  for  printing  or  plotting  as 
required . 

PRIMIT  (Fig  A. 20) 

PRIMIT  is  an  auxiliary  routine  used  by  DDTCON  and 
CDTCON  for  optimal  deterministic  controller  gain  calculations. 
It -transforms  a  given  system  of  equations  with  non-zero  cross 
cost-weighting  matrices  to  an  equivalent  system  of  equations 
with  zero  cross  cost-weighting  matrices.  The  requirement  for 
and  details  of  this  modification  are  discussed  in  Appendix  C. 
CDTCON  and  DDTCON  transform  the  resulting  optimal  feedback 
gain  matrix  back  to  a  form  consistent  with  the  original  system 
equations . 

MHATIO  (Fig  A. 21),  MVECIO  (Fig  A. 22) 

These  subroutines  are  auxiliary  routines  that  are 
called  by  most  other  subroutines  to  perform  input  and  output 
of  matrices  and  vectors  respectively.  Both  routines  perform 
actions  on  the  desired  array/vector  based  on  the  value  of 
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Three  parameters,  10,  KIN,  KOUT.  KIN  and  KOUT  tell  the  rou¬ 
tines  which  file  to  read  from  or  write  to,  respectively.  10 
can  have  any  o£  5  values;  1,  2,  3,  4,  5.  If  10=  1,  the  rou¬ 
tines  read  all  elements  in  list  directed  (and  row  by  row  for 
arrays)  format.  10=  2  rerforrr.s  the  same  read  but  also  write 
out  the  entire  array /vector .  10=  3  lets  the  routine  read 

^elected  elements  in  the  array/vector.  10=  4  performs  the 
same  read  function  as  10=  3*  but  it  then  prints  the  values 
read.  10=  5  causes  the  routine  to  print  out  the  entire  ar¬ 
ray/vector.  Note  that  if  10  is  any  number  than  those  listed 
above,  a  call  to  these  subroutines  produces  no  action  other 
than  a  return  to  the  calling  program. 

AUGMAT  (Fig  A. 23) 

The  subroutine  AUGMAT  is  an  auxiliary  routine  used  to 
form  augmented  matrices.  Based  on  the  flag  IFDRM,  AUGMAT 
either  forms 

or  [A  b] 

when  given  the  two  matrices  A  and  B  and  their  dimensions. 


* 
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Appendix  B 
Software  Source  Code 

This  appendix  contains  the  FORTRAN  V  software  written 
as  a  result  of  this  thesis.  The  FORTRAN  V  source  code  imple¬ 
ments  the  flowcharts  that  are  specified  and  discussed  in  Ap¬ 
pendix  A. 

*  Table  B.l  contains  a  listing  of  the  variables  as  used 

in  the  various  sections  of  this  thesis  along  with  their  FOR¬ 
TRAN  V  counterparts  as  used  in  the  software. 
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Notes : 


TABLE  £.1  (con’t) 


a.  A  "D"  appended  to  the  right  side  of  the  Fortran  vari¬ 
able  indicates  vthat  it  is  an  equivalent  discrete-time  repre¬ 
sentation  of  the  variable.  For  example,  BTD  is  the  equi¬ 
valent  discrete-time  counterpart  of  Bj. . . 

a  CL 

b.  A  "T"  appended  to  the  right  side  of  the  Fortran  vari¬ 
able  or  expression  that  designates  a  matrix/vector,  indicates 


that  the  matrix/vector  is  transposed.  For  example,  HTT  is 


c.  An  ”1"  appended  to  the  end  of  a  Fortran  variable  or 


expression  that  designates  a  matrix/vector  indicates  that 

—  1 

the  matrix/vector  is  inverted.  For  example,  PKIKI  is  £~ 


uuu  ooou 


tCCCK  LQGRP 

PROGRAM  LOGRP I 0UTPUT»S4, TAPES • OUTPUT, TAPEl8*64,TAPEt 3*64, 

JTAPE 1 4*64,TAPE16*64 , INPUT *64, TAPE l 6* 1N®UT , TAP£B*64. TAPE7 ) 

C  THIS  PROGRAM  PERFORMS  A  PERFORMANCE  ANALYSIS  FOR  THE  LINEAR  QUADRATIC 
C  GAUSSIAN  CONTROLLERS  DESCRIBED  BY  DCX >/DT*FX+BU*CU  AND  A  QUADRATIC 
C  COST  FUNCTION,  IF  DIFFERENT  CONTROL  ALGORITHMS  ARE  SUPPLIED  THE 
C  PROGRAM  WILL  STILL  DO  A  PERFORMANCE  ANALVSIS.  THE  METOHODOLOGV  IS 
C  RASED  ON  THE  OERF  ANAL.  SECTION  IN  CHAPTER  14  OF  P.  S.  MAYBECKS 
C  TO  BE  PUBLISHED  UOLUHE  8  OF  STOCH, MODELS, EST  AND  COHTROL 


VOLUME  8  OF  STOCH, MODELS, EST  AND  COHTROL 


MAHV  OF  THE  SUBROUTINES  USED  FOR  MATRIX  MANIPULATION  COME  FROM  THE 

ROUTINES  COMPILED  BY  D.  KL1ENMANCTR-7S-4 ,  OHR  CONTRACT  t 
H«eei4-?5-C1067) 

IN  THE  FOLLOWING  PROGRAM  TRUTH  MODEL  MATRICES  ARE  TWO  LETTERS  WITH 
THE  LAST  LETTER  BEING  -T-  .  CONTROLLER  MODEL  MATRICES  ARE  TWO 
LETTERS  ENDING  IN  -M-.  -T-  FOLLOUING  APARTICULAR  MATRIX  NAME 

INDICATES  THE  MATRIX  IS  TRANSPOSED.  -I-  FOLLOUING  A  PARTICULAR 
MATRIX  NAME  INDICATES  THE  INVERSE  OF  THE  MATRIX 


COMMON  BLOCKS  MAIN!, MAINS, IHOU  ARE  REQUIRED  BV  THE  KLIEMAH  ROUTINES 
- INPUT  FROM  TAPEie  - OUTPUT  TO  TAPEil 

CHARACTER  MSCX60 

REAL  FT<S.S),BT(5,S).GT(S,S>,HT(S,S).RM(5,SJ, 

1  FM(S,S),BM(S,5),CM(S,S),X0C5),HM(S,5),QM(S,S), 

1  POCS.Sl.QTtS.Sl.RTtS.Sl.COMltie.lSJ.COnSaR.iei.GCSTRlS.S 

n.lttU<5.S),RKFSS<S:5Tr&Ur<S)7B02<S77  _  _  _ 

lWMl(S,S),UH2tS.5).WH3CS.S),WM4(S,S).UMSCS.S).UM6tS,S), 


1  PXTHINtS l.PXTMAX l S I.PUMINIS l.PUMAXlS l.GCZAt 16. 16  >. 

1  RAt 16. 16 1 ,icV(5,5) , BCZ(6,S  > ,CCV(S,S ),FCIS,5 >, 
lUM7(S,Sl,UM8(S,S),UM8(6.5),Uni6«S,4),UU3(16),UU4(16) 

INTEGER  IFLGCZ, IRV 
REAL  NU<S> 

COMMON  /RNTIM/  RNTIME.DELTIM 
COMMON  /MAIN2/COMS 
COMMON  /MAINl/NDIM.NDIMi.COMl 
COMMON  /  INOU/  KIN.KOUT.KPUNCH 
COMMON  /MAIN4/NDIM2.ND1H3 
COMMON  /MAUN5/  MSG 

COMMON  /MAIN6/  ICBT, ICBH. ICFA, ICCA, ICGM, ICCT, ICOA.IRFA, IRFM, JRFT, 
1  IRHT, IRQA.10.LOG, IRHH.NUMDTS 


DATA  UNA , WM8 , UHC . WMD , WME , UMF  ✓666*6.8/ 

DATA  QA,COMl,COM2,FA,BA,GA,PXA,PXUA  /886*6.6/ 

DATA  UU3.UU4  /26X6.6/ 

DATA  WM 1 , UM2 , WH3 , WM4 , WMS , WM6 , FT, BT, CT, HT  /258I6.6/ 
DATA  UUU,UXX,FM,BM,CM,PO,QT,UXU  /266S6.6/ 

DATA  RT,GCSTR,RKF$S.CCX,CCZ  /185X6.6/ 

DATA  UU1,UU2,X0,MXA,MU  /36S6.6/ 

DATA  RM.QM.HM  / 76*6.6/ 

DATA  IFLGCZ  /8/ 


KIN* 16 

KOUT*6 

KPUNCH*7 

NDIM»S 

NDIM1»6 

NDJM2»16 

NDIM3-1666 


XXSXXXXSXMAIN  PROGRAM  FOLLOWS  SSSSXSS 

C -  IRXX,  ICXX  INDICATE  ROUS, COLUMNS  OF  MATRIX  XX 

C 

CMSMTHIS  PROGRAM  CAN  HANDLE  UP  TO  1666  DIFFERENT  COHBINATIOS  OF 
C  RUNTIME. DELTIM, AND  UNSPECIFIED  PARAMETERS 

DO  8938  LOO- 1.1666 
WRITE (KOUT.ll )'  ' 
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it 

12 


.  FORHATCAl,/' 

FORMATtAil  ..  WH  m<J«SER  '.'■gO  Rf  M 

^?[EiKWwn!^y!HT:r«.r..cri.Hn.po.oT.c«.Rt.«r, 

i  c  uuu  >  w**  <  WXU ) 

IF  CO.EO.C)  THEM 
00  TO  2533 

c2u:RCSiCCSTR;RKF|S^|X,0CV,CCZ^Cy£»C|,FC^Cj^^ 

cl0S 

t  V  OR  to* 

iSfeose^  «™»  E'~ 

1  ARE. ..' 
ksav-hdim 
K0IH-MDW2 

Sll1  net  C^u?v» ,  UU3 .  uu^.  i»fr.u"E  i 
noim-nsav 

NDIMl-NSAV+l 

v  to  k»»  « ,mW5IS-  ,vf£ 

tF  tftSG.EO.'N MTHEM 
00  TO  2S32 

HH  ^m^touT.ti' program  term i mated,  mo  more-Imput  data' 

***  CNt 


tEK  TH£  SIJE  „  « 

^tIaRRAVS.STORXX.  ^t^It  RUMTir.EtD|LTlM*|y  «  |fetH 

JumserRof  ^^scave^actor^or  Tie  the  m 


0PEH(UMIT*iJ.652'*-'u:rE..TAPEH',MtfcP’»'' 
0PEMtUMjT.l4,|RR*l|.T^|.,TW,E1S<  ReCU-M) 

OPEM « UMH • ' IS » e**I££h  RMT  J  ME ,  DEDT  IT. ,  1 S 1  ||Z 

silisps® 

FORMAT!' 

SfeV^VJt’t-o  or  nit  »  tHt.. 

close  ag. 
close(13.|25  }!« 

CLOSE a A, ERR* IJ 
CLOSE! IE. ERR* !• ' 

iiillllli 
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I 


noono  ooooo  r> 


RETURN 

16  WRITE i ICOUT,* ) ' AN  ERROR  HAS  OCCURRED  IN  THE  STORED  ROUTINE' 
iea  formatoiac  ',£18.6,1),/)) 

END 

tDECK  INPUTH 

SUBROUTINE  INPUTnfFT.BT.CT.HT.FH.BM.CH.HM.PO.OT.QM.RT.Rn.XO 
l.UUU.UXX.UXU) 

CHARACTER  B$CtE0 

REAL  FT(NDXH,NDJM),BT (NDIN,NDIH).GT(NDIK,NDZH),HTCNDIH,NDIH5,HHtND 
1IN.NDIH  ),ON(NDIH,NDIH )  ,RH(NDIN,NDIH )  ,XO(NDIH ), 

1  UUU(NDIH.NDIN),UXX(NDIH,NDIH  ),FH(NDIN,NDIH >j BN INDIA, NDIH), 

1  CN<NDin,NDIM).UXU<NDln,NDlH>, 

1  POtNDIM.NBIH ),  DT 1  NDIN.NDIfi  ),RT(ND1N,NDIH )  ,COni ( 1  ),CQH£( 1  ) 

COMMON  /MAIN4/NDIMH.NDIH3 
COMMON  /HA1N2/C0M2 
COMMON  /HAlNl/NDIH.NDIM.COHi 
CONNON  /  INOU/  CIN.KOUT.KPUNCH 
CONNON  /HAUNS/  NSC 

COMMON  /NAIN6/  ICBT.ICBM.lCFA.lCCA.ICCn.ICCT.ICOA.lRFA.IRFH.IRFT. 

1  IRHT, IRQA, IO,LQG, XRHH.NUNBTS 

«$«•'  ***** - ***** - ***** - ***** - ***** ' 

ICFT-IRFT, ICFN-IRFH.IRBT- IRFT, IRBN-IRFH, 1RGT- IRFT, 1RCH* IRFN 
IRX-IRF,IRO-ICO-ICGH,XPR-ICR-IRHT.IRUXX-ICUXX-IRFH, 

-  IRUULP ICUUU- ICBN, ICHT • IRFT. ICHN- IRFN. IRCCZ • I CBT , 1CCCZ- IRHT , 
10  IS  A  INPUT  ROUTINE  PARAMETER— 1-READ, 2-READIPRINT. 

3*  PRINT  ONLY,  4. PUNCH 

NSAU-HDIHl 
NDIHl-NDIH 


IRX- IRF. IRQ* ICO* ICON, IRR- ICR* IRHT, IRUXX- ICUXX-XRFH, 

IRUUU- ICUUU-  ICBH.  ICHT- 1 RFT,  ICHN-  IRFN.  IRCCZ- ICBT, ICCCZ- IRHT, 
10  IS  A  INPUT  ROUTINE  PAHAMETER--1 -READ, 2-READIPRINT, 

3-  PRINT  ONLY.  4-PUNCH 


NSAW-NDIM1 
NDIHl-NDIH 
IF  ( LOG . CO . 1 )  THEN 
URITEOCOUT.*  1HSG1 

URITEOCOUT,*  )'THE  I/O  OPTIONS  ARE  6, l, 2. 3, 4,5.6 . ' 

URITEOCOUT,*)' 1-READ  ENTIRE  ARRAY/UECTOR. 2-READ  AND  PRINT' 
URITEOCOUT.*) 'ENTIRE  ARRAY/UECTOR,  3-READ, AND  4-READ  AND  PRINT' 
URITEOCOUT.*) 'SELECTED  ARRAY/UECTOR  ELEMENTS.  S  PRINT  ENTIRE' 

UR  I  TEt  ICOUT ,  i  )  ’  ARRAY/UECTOR .  6  OR  CREATER  NO  PORE  INPUT  TO' 

URITEOCOUT,* )  'BE  HADE.' 

URITEOCOUT.*  )P.SG1 

URITEOCOUT,*  )'SELECT  WHICH  MATRIX  YOU  WISH  TO  ENTER.' 

URITEOCOUT,*  )'BV  ENTERING  THE  APPROPRIATE  NUMBER.  1-FT.2-BT' 

WRITE  OCOUT,X)'3-CT. 4-HT.5-FH.6-BH, 7-CH.8-HH.9-P0. IB-0T,X1-RT,>' 
WRITE OCOUT. * ) '  12-ON, X3-RH, 14-XO, 15-WUU, I6-UXX, 17-UXU, 18-EOUATE  ALL 


URITEOCOUT,*  )'CONTROLLER  NODEL  HATICES  TO  THEIR  ' 

URITEOCOUT.*) 'TRUTH  MODEL  COUNTERPARTS.  19 - NO  MORE  DATA' 

URITEOCOUT,*) 'ENTRIES  TO  BE  HADE,  26— STORE  ALL  MATRICES  ON  TAPE?' 
URITEOCOUT,*) '21-  READ  ALL  MATRICES  FROM  TAPE8' 

URITEOCOUT.*  )MSGl 
URITEOCOUT.*  )MSG1 
URITEOCOUT.*)'  ' 

URITEOCOUT.*) 'FOR  SAMPLED  DATA  MEASUREMENTS, ENTER  EITHER  A  CONTINU 
10US  RM  TO  USE  TO  APPROXIMATE  THE  DISCRETE  TIME  RMD ( RMD -RN/SAMP LE 
1TIME)  OR  ENTER  THE  DISCRETE  TIME  RMD' 

URITEOCOUT.*  )HSGi 
URITEOCOUT,* )MSG1 
END  IF 

DO  982  INPUT- 1,1699 
^  WRITE  OCOUT, 33333)'  ' 

33333  FORMATtAt*,/) 

REAdUin^*)IWCH|Ja:R  C0DC  F0*  WHICM  *RW>V/yECTOR  TO  BE  !N»UT>' 


GO  T0( 1,2. 3, 4, 6, 6,7,1,9,16,11, IE. 13. 14, IS, IS, 17, 18, 18, 26, 21 )1UCHMA 

C 

CKXTRUTH  MODEL  INPUT 

1  URITEOCOUT,*  )'ENTER-I/0  OPTION,  FT  MATRIX  SI2E>' 

READ  OCXN,*,  END-27  >10,  IRFT 

MSG- 'TRUTH  MODEL  F  MATRIX  ENTRIES' 

CAU  HMATIO  <FT,  IRFT,  IRFT.  10, KZN.ICOUT.NDIH.NDIHl) 

IF  ( 10.E0.6 )  THEN 
RETURN 
END  IF 
CO  TO  M2 
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2  URlTE(K0UT,*)'ENTER-I/0  OPTIONS,  COLUMN  SIZE  OF  *T>  ' 
READ<KIN,*,END-27)I0,ICBT 

MSG- 'TRUTH  flODEL  8  MATRIX  ENTRIES' 

CALL  MMATIO  (BT ,  IRFT ,  ICBT , I0,K1N,K0UT,NDXM,NDIMX ) 

IF  U0.E0.8)  THEN 
RETURN 
END  IF 
CO  TO  982 

3  MRITE(KOUT,x J'ENTER-I/O  OPTION.  COLUMN  SIZE  OF  CT>' 

READ< KlH.t, END-27 ) 10, ICCT 

MSC- 'TRUTH  MODEL  C  MATRIX  ENTRIES' 

CALL  MMATIO  ICT.IRFT.ICCT.lO.IClH.ICOUT.NDIH.NBIMi  ) 

IF  ( 10. £0,8 )  THEN 
RETURN 
END  IF 
CO  TO  982 

4  URITEIKOUT,*) 'ENTER-  I/O  OPTION.  ROW  SIZE  OF  HT> ' 

READ < K IN, X . END-2? J 10 . IRHT 

MSC-'H  MATRIX  ENTRIES' 

CALL  MMATIO  (HT , IRHT , IRFT, 10, KIN, ROUT, NDIR.HDXMl > 

IF  ( 10. £0,9 )  THEN 
RETURN 
END  IF 
CO  TO  982 

CWtINPUT  CONTROLLER  MODEL 

5  URITtCICOUT,*  VENTER-1/0  OPTION,  FN  MATRIX  SIZE>  ' 

READ ( K IN. * .END-2? 3 10 . IRFM 

HSO • ' CONTROLLER  MODEL  F  MATRIX  ENTRIES' 

URITE<KOUT.*> 'ENTER  THE  NUMBER  OF  DETERMINISTIC  STATES  IN  THIS  MOD 
1EL> ' 

READIKIN, *, END-27 jNUMDTS 

CALL  HfWTIO  (FN,  XRFH,  IRFM, ZO.KXN.KCUT ,HDIM,NBXM1) 

IF  (10.EQ.9)  THEN 
RETURN 
END  IF 
CO  TO  982 

6  URITEOC0UT,*>'ENTER-I/0  OPTION,  COLUMN  SIZE  OF  BM> ' 

READ ( KIN, x,£ND-27 >10, ICBM 

MSC- 'CONTORLLER  MODEL  I  MATRIX  ENTRIES'  _  . 

CALL  MMATIO  CBM,  IRFM.  ICBH.  lO.KIN.KOUT.NDIM.NDim  > 

if  ao.co.8)  THEN 

RETURN 
END  IF 
CO  TO  982 

7  URITEIKOUT. t) 'ENTER- I/O  OPTIOH.  COLUMN  SIZE  OF  CM)' 

READ (KIN,*, END- 27  >10, ICGM 

MSC- 'CONTROLLER  MODEL  C  MATRIX  ENTRIES' 

CALL  MMATIO  (GH.IRFM.ICCN.XO.KIN.KOUT.NDIN.NDIMl) 

IF  UO.EQ.e)  THEN 
return 

END  IF 
CO  TO  982 

8  wRITEOCOUT.l)  'ENTER  I/O  OPTION, ROW  SIZE  OF  WO  '  ' 

READ  UUN  ,  1 ,  END  •  c? )  1 0 ,  IRHN 

MSC- 'THE  CONTROLLER  MODEL  MEASUREMENT  MATRIX,  HN,  IS' 

CALL  MMATIOCHN. IRHM, IRFM, I0,KIN,K0UT,NDIM,HDIM1 ) 

IF  (10. EC. 9)  THEN 

RETURN 

EHDIF 

CO  TO  982 

9  URITEIKOUT. t  > 'FT  MUST  BE  ENTERED  THRU  OPTION  1  PRIOR  TO  USING  THIS 
i  OPTION. DO  YOU  WISH  TO  ABORT  THIS  OPTION,  YORK)' 

READ < K IN, 9? . EHD-27 )MSC 
IF  (MSC.EQ. 'Y' i  THEN 
CO  TO  982 
END  IF 

WRITEtKOUT.B) 'ENTER  I/O  OPTION, IRFT  IS  ASSUMED  SIZE  OF  P0> ' 
READIKIN,*, EHD-27) 10 

MSC- 'THE  INITIAL  COUARIANCE  MATRIX.PC,  IS' 

CALL  MMATIO  <po,irft,:rft,io,kin,kout,ndim.ncimi ) 

IF  ( I0.E0.8)  THEN 
RETURN 
END  IF 
CO  TO  982 

u° op,,c"' ,C5T  ,s  *tsma  «»  »  «>• 

MSC* 'THE  INPUT  NOISE  STRENGTH  MATRIX  OT  IS' 

?2LK5"2IX2 . (2T*ic®T» 1CCT, io.«n,kout,hd:m,ndimi  ) 

IF  (10. CO. •  )  THEN 
RETURN 

end  rr 
CO  TO  982 
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WRITE (KOUT,X )  'ENTER  I/O  OPTION, IRHT  IS  ASSURED  SIZE  OF  RT>  ' 
READ (KIN, * .END- 27 )10 

MSG-  'THE  MEASUREMENT  NOISE  STRENGTH  MATRIX  RT  IS' 

CALL  N RATIO  (RT, IRHT, IRHT. 10 , KIN, KOUT.NDIM.NDIMl 1 
IF  (lO.EO.e)  THEN 
RETURN 
END  IF «. 

CO  TO  S8S 

URITE(KOUT,X> 'ENTER  I/O  OPTION, ICON  IS  ASSURED  SIZE  OF  OK> ' 
READ(KIN,X, END-2? >10 

MSG- 'CONTROLLER  MODEL  INPUT  NOISE  STRENGTH  MATRIX,  OM' 


CALL  MMATI0(QM, ICGM.ICCM, IO,KIN.KOUT,NDin.NDIMl > 

IF  ( IO.EQ.0  )  THEN 
RETURN 
END  IF 
CO  TO  982 

URIT£(KOUT,X) 'ENTER  I/O  OPTION,  IRHN  IS  ASSUMED  SIZE  OF  RN> ' 
READtKIN.X, END-27 >10 

MSG- 'CONTROLLER  MODEL  MEASUREMENT  NOISE  STRENGHT  MATRIX,  RM' 

CALL  MMATIO(RM, IRHPi, IRHM,10,KIH,K0UT,NDIM,NDIM1 1 

IF  UO.EO.ei  THEN 

RETURN 

END  IF 

00  TO  982 

.U5IIfi£OUTt,5'rT  ,1UST  *E  ENTERED  thru  OPTION  1  PRIOR  TO  USING  TkTS 

nan  T“,‘  v  M  “  T 

IF  (MSC.EO. 'Y'  )  THEN 
CO  TO  982 
END  IF 

READ (KIN^X^END-27^10^  *'°  0PT10N'1RFT  IS  *«UNED  »ZEO F  X0>' 
MSC-'TKE  INITIAL  STATE  VECTOR,  XO,  IS' 

iFL(ioWMIei(?SENRFT*IO'KIf<’<OUT'NDI,,> 

RETURN 
END  IF 
CO  TO  982 

1  G 312 ' B *E  ENTERED  thru  OPTION  6  OR  17  PRIOR  TO  USfN 

“,s" T0  ‘,‘”T  ™IS  5  ™  «>° 

IF, (MSC.EO. 'Y' )  THEN 
CO  TO  982 
END  IF 


REmISu^E^IthS  1/0  0PT10M'ICM  15  SIZE  OF  UUUV 

MSC-'THE  CONTROL  FUNCTION  COST  WEIGHT INC  MATRIX  UJU' 

IF^nO^Eoioi^THEN5^"  1°^^’  ^  I  ^  ^  )^^ 

RETURN* 

END  IF 
GO  T0982 

. *  *EH  MUST  8E  ENTERED  THRU  OPTION  5  OR  17  PRIOR  TO  LfSIN 

READ(CIN^97?END-27 1MSC  UISM  T°  *MRT  TH1S  0PTI0M'  Y  °*  M>' 

IF  (MSC.EO. 'Y')  THEN 
GO  TO  982 
END  IF 

READfKlS^'.END^IO1'0  OPT10N'IRrB  »  ASSUMED  SIZE  OF  UXX>< 

MSG- 'THE  STATE  COST  WEIGHTING  MATRIX  Uxx' 

IF^IO?^!#  ^THEN*™'  IRF"'  ,0*KIN«K0UY-N®IM,NDIM1 1 
RETURN* 

END  IF 
00  TO  982 

WRITE (KOUT.X) 'ALL  CONTROLLER  MODEL  MATRICES  HAUE  SEEN  SET  EQUAL  TO 
1  THEIR  TRUTH  MODEL  COUNTERPARTS' 

WRITE (KOUT.X  )'FT,BT,CT,HT,OT ,RT  MUST  BE  ENTERED  PRIOR  TO  USING  TNI 
IS  OPTION.  THE  NUMBER  OF  DETERMINISTIC  STATES  MUST  BE  ENTERED  IN 
1  THIS  OPTION (FOR  CONTROLLER  MODEL).' 

WRITEOCOUT ,  *  > '  DO  YOU  WISH  TO  ABORT  THIS  OPTION,  Y  OR  N>  ' 

READ! KIN, 97, END-27 1MSC 
IF  (MSC.EO. 'Y'l  THEM 
CO  TO  982 
END  IF 

WRITEUOUT. 81 'ENTER  THE  NUMBER  OF  DETERMINISTIC  STATES  IN  THE  CONT 
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1R0LLER  MODEL> ' 

READ ( KIN, X, END-27  )NUNDTS 

IRFM-IRFT 

FORMAT (A1  ) 

ICBM-ICBT 

iccm-icgt 

IRHM- IRHT 

CALL  EQUATE (PM, FT, IRFT ,  IRFT  ) 

CAU  EQUATE ( BN, BT, IRFT, ICBT ) 

CAU  EGUATE(GM,CT, IRFT, ICGT ) 

CALL  EOUATE<  HN.HT , IRHT , IRFT ) 

CALL  EQUATE < ON ,OT,  ICCT,  ICCT ) 

CALL  EGUATECRN.RT, IRNT, IRHT ) 

CO  TO  982 

WRITE(KOUT,X ) 'NOTE  THAT  FM  AND  BP1  MUST  BE  ENTERED  THROUGH  APPROPRI 
1ATE  OPTIONS  PRIOR  TO  EXECUTING  THIS  OPTION.  DO  YOU  WISH  TO  ABORT  T 
1HIS  OPTION,  V  OR  N>' 

READ ( K IN . 97 . END-27 )MSC 
IF  (MSC.EO.'Y')THEN 
CO  TO  982 
END  IF 

WRITE ( KOUT ,  X ) ' ENTER  I/O  OPTION,  IRFM  X  ICBN  ASSSUNED  SIZE  UXU>' 
READ(KIN, X, END-2? )IO 

NSC- 'THE  CROSS  (ST ATE -CONTROL >  COST  WEIGHTING  MATRIX.  UXU' 

CALL  MMATIOCUXU, IRFM. ICBM, 10, KIN, KOUT, NDIM.NDIM1) 

IF  (IO.EQ.OTNEN 
RETURN 


END  IF 
GO  TO  982 

URITE(KOUT,x ) '  THIS  OPTION  STORES  ALL  MATRICES  ON  TO  TAPE7,  DO  YOU 
l  WISH  TO  ABORT  THIS  OPTION, Y  OR  N> ' 

R£AD(KIN.97mSG 

IF  (RSC.EO.'Y' JTHEN 
CO  TO  982 
END  IF 

URITEI?.X)1RF7. ICBT, ICCT, IRHT, IRFM, ICBM, ICCM, IRHM.NUMDTS 
WRITE(7,X)((FT(I.J).J.1,IRFT>,I.X,IRFT),C(BTCI,J),J.1,IC1T),I.1,IR 
1FT ),<  <CT(  I,  J  >, J-l,  ICGT >. I-l, IRFT),  (<MT(I.J>.  J-l, IRFT), I-l, IRHT )| 
1<(FM(I,J),J*1, IRFM  >, t -1 , IRFM ), ( ( BMC  I , J ), J-l, ICBH ), 1*1, IRFM ) 
URITEC7.X )((CM(I,J),J>1, ICCM  ), I » 1 , IRFM ),UHM(I,J),J-1, IRFM  >, l-l ,  IR 
1HN),((P0(I,JI,J-1,  IRFT  ) , I -1 ,  IRFT ),  ( X0(  I  ),  1*1.  IRFT ),  ( (WUU(  I,  J ), 
1-J-l,  ICBM  >.  I  ■  1,  ICBM  ),<<UXX(I,J).  J-l,  IRFM).  I-l,  IRFM) 

■WRITE  ( 7,  X  ><  (QT(I,J),J-l,  ICCT  ),  I  •  1 ,  ICCT ),  ( (RT(  I ,  J  ), J-l, IRHT ), l  •  l,  IR 
1HT),((0M(I,J),J*1,  ICCM  ) ,  I  *  1,  ICCM  ) ,  ( (RM(  I ,  J  >, J-l, IRHM ),  I-l ,  IRHM  ) 
URITEC7,XH(UXU(I,J),J-1,ICBM),I.1,IRFM) 

GO  TO  982 

WRITE(KOUT.X)'  THIS  OPTION  READS  ALL  MATRICES  FROM  TAPES,  DO  YOU 
1  U1SH  TO  ABORT  THIS  OPTION,  V  OR  N> ' 

READCKIN.97 )NSG 
IF  (MSC.EQ.'V')  THEN 
CO  TO  982 
END  IF 

WRITE  (KOUT , X ) 'DO  YOU  UISH  TO  REWIND  TA«>E8  BEFORE  THE  READ,  Y  OR  N>  ' 
READ(KIN,9? )MSC 

IF  (MSC.EO.'Y* )  THEN  , 


REU1NDC8 )  , 

END  IF 

READ (8.X, END* 18833  > IRFT, ICBT , ICCT, IRHT, IRFM, ICBM, I CGM, IRHM.NUMDTS 
READC  8,X,END*  18833)(<FT(I,J),J-1,  IRFT  ),  1  *1 ,  IRFT ),  ((BT(I,J),J-1,1CB 
IT ) , 1*1 , IRFT ),((GT(I,J),J«1, ICCT  ) , I -1 , IRFT  ) , ( (HT( I , J )» J- l» IRFT ), 1  *  1 
1, IRHT ),( (FM( I, J ), J*l, IRFM), !• 1, IRFM), ( CBM(I, J).J«1, ICBM), I»l. IRFM I 
READ(S,X,END-18833)<(CM(I,J), J-l , ICCM ), I -1. IRFM). C (HM(I, J ), J* t ,IRF 
1M ),  I-l, IRHM ),((PO(I,J ), J-l, IRFT  ), I-l , IRFT ),(X0(I),1-1 , IRFT), ( (WUU( 
1  I, J), J-l, ICBM), I-l,  ICBM  ),  <  (WXX(  I,  J  ),  J-l ,  IRFM),  I -I,  IRFM  ) 

READ (8, X. END- 18833  )<(QT(I,J),J-l, ICCT  ) , l-l , ICGT ), ( (RTC I , J ) , J-l,  IRH 
IT ), I-l,  IRHT ),  ( ( 0M<  I,  J ),  J-l, ICCM ),  1- l.ICGM ),  ( (RN(  l, J  ), J-l, IRHM), 

1  I-l, IRHM) 

READ(8,x)(  (UXUtl.J),  J-l.  ICBM  ),I-1,  IRFM) 

GO  TO  982 

18(533  URlTE(KOUT,X ) 'END  OF,  FILE  ENCOUNTERED  DURING  READ  OF  TAPES' 

982  CONTINUE 

19  CONTINUE 

'  NDIM1-NSAU 
RETURN 
27  10-8 

C 

'  END 
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xDECK  NEIGN 

SUBROUTINE  NEICNtA.AREV.AIEU, CURSZA, UM > 

character  i*.SGxse 

DINENSIONA(NOIN,NDIH }, AREUINDIN  >, AIEV(NDIN ),UHl(NDIN,NDIN ) 

D1NENSI0N  COM(l>,COH2U) 

CONNON  -'NAlNl/NCln.NDirtl.COm 

connon  /  inou/  kin.kout.kpunch 

CONNON  /NAIN2/  CONE 
conn ON  /HAUNS/  NSO 

C  THE  CALLING  ROUTINE  BUST  SUPPLY  A  WORKING  NATRX  NDIN  X  NOIN  —UNI 
CXXlFlND  THE  EICENUALUES  OF  A  ,NR-B  TEUS  THE  ROUTINE  TO  CALCULATE 
C  EICENUALUES  ONLV 

C  NOIN  NUST  BE  THE  DINEhSION  OF  A  IN  THE  CALLING  PROGRAM 
C  CURSZA  IS  THE  CURRENT  SIZE  OF  A 

NR-6 

ct-t.e 

CALL  IDNT(CURSZA,UNl,Cn 
C  UNI  • I  CURSZA  X  CURSZA 

CALL  EICEN<CURSZA,A.AREU.AIEU,UNt,NR) 

IO-S 

NSAU-NDIN1 

NDIHl*NOIN 

NSC- 'REAL  PARTS  OF  TVC  EICFNVAturc  • 

Nsc- * 

c  C*Lt  HWECI°  (AIEU,CIRS2a,IO.KIn,KOUT,HDIN> 

Norm-NSAw 

END 

rDECK  CDTCON 

. . 

CONNON  'HAIN2/C0N2 

/,,,AIN1  /’NDIN,  NCINI  CONI 

c  cS™  UXS& 

CXXXDETERNINISTIC  CONTROLLER  GAIN  CALCULATION - NODULE  *  i 

THIS  NODULE  CONPUTES  THE  STEADV  STATE  DETERN1NISTIC  CONTROLLER 
GAIN  NATRIX,CCSTAR-<UUUIHBNT>(KCSSPN>.  UUUI  IS  THE  INUERSE  OF  T 
CONTROL  COST  WEIGHTING  NATRIX,  KCSSPN  IS  THE  STEADV  STATE 
SOLUTION  TO  DtKC  J'DT- (FNT  HKC  H(KC  )  (FH  )-UXX-(KC  HBN  )  (UUJI  >  ( 8NT  )X 
(KCJ.  UXX  IS  THE  COST  WEIGHTING  NATRIX  ON  THE  STATES 


KLIEHNAH  ROUTINES  ARE  EXTENSIUELV  USED  IN  THIS  NODULE 
C  TRAHSFORN  SYS7EN  SO  THAT  UXU  NOT. 6  CAN  STILL  BE  HANDLED  BY 
C  KLEINNAN  ROUTINES,  SEE  KUAKERNAAK  AND  SlUAN'S  BOOK.  PAGE  322 

CALL  PR1NIT(WN1.WUU,ICBN,CCSTR.UXU,IRFN,BN,WN2,FPRIN,UXX,UXXPRN, 
1  FN) 

C  HOW  HAUE  FPRIN,  UXXPRN  CAN  USE  RICCATI  SOLVER  FOR  KCSSPN 
NT-1 

CALL  TRAMSBURFN.ICBN.BN.UN2> 

C  UN2-BNT  ICBN  X  IRFN 

CALL  EOUA TEC WNl.WUU, ICBN, XCBN ) 

C  CNINW  DESTROYS  THE  CALLING  ARRAY 

CALL  GNINUt ICBN, IC8N.WN1 ,WN3,NR,NT > 

C  UN3-WUUI  ICBN  X  ICBN - NR  IS  AH  ERROR  INDICATOR 

IF  (BR.NE.ICBN)  THEN 

PR1HTX, 'AN  ERROR  OCCURRED  IN  INVERTING  UUt,  NR- ' ,BR, * ICBN- ' , ICBN 
END  IF 

CALL  EOUATE (UNI, UN3, ICBN, ICBN l 
C  WNl-UUUI  SAUE  FOR  LATER  CONFUTATIONS 

CALL  NATKUN3.WN8.  ICBN,  ICBN,  IRFN.UN4  ) 

C  UN<-(UUUI HBNT)  ICBN  X  IRFN 
C  NOW  CALL  RICCATI  EQUATION  SOLUER 

CALL  NAT1<BN,UN4,IRFN,XCBN,1RFN,UN3) 

C  UN3-BN(WUUI HBNT )  IRFN  X  XR*N 

CALL  NRIC< IRFN, FPRIN, UN3, UXXPRN, UN2.WNS ) 

C  WN2-KCSSPN  IRFN  X  IRFN 

C  WN6-fN“BN(UUUI HBNT) (KCSSPN) - 1  DONT  USE  THIS  RESULT 

NSC- 'KCSSPN  FOR  THE  DETERNINISTXC  CONTROLLER  IS' 

10-5 


NSAU*NDIN1 

noimj-ndin 

CALL  HNATI0(UN2,IRFN.IRFN,10,K1N,K0UT,NDIM,ND1N1  ) 

C  NOW  CALCULATE  OPTICAL  GAIN  MATRIX  GCSTAR.  NOTE  I  NEED  THE 

C  NEGATIVE  OF  CCSTAR  FOR  THE  CONTROL  LAU  GENERATION  FROM  AN  LOG 

C  CONTROLLER.  AND  THIS  WILL  BE  THE  GCX  REQUIRED  IN  THE  PERFORMANCE 

C  ANALVSIS  ROUTINE 

NDIMt»NSAU 

C  NOU  HAVE  KCS9PN  ,  CALCULATE  GCST* . UUUI C  BMT  t  KCSSPH )  *UXUT  ) 

C  RECALL  UUUI  IN  UR1 
CI-I.B 

CALL  NAT4AI BM,UM2,ICBM, IRFN, IRFH.UM4 J 
CALL  TRANS2( IRFM, 1CBN,UXU,UM3 ) 

CALL  NADD1 ( ICBM, IRFN.WN4 ,UN3,UN8.C1 ) 

CALL  NATl  (WfU,UM2,  ICBN,  ICBM,  IRFM.GCSTR  ) 

N$AU»ND!R1 

NDinioNDin 

IO-S 

C  CCSTR  ICBN  X  IRFN 

N5G*'THE  OPTIMAL  STEADY  STATE  FEEDBACK  gain  MATRIX.  GCSTR' 

CALL  MMATIOtCCSTR.  ICBM,  IRFM,  10.  KIH.KOUT.HDIM.HDWU 
NDIMi-NSAU 

c 

END 

XDECK  CKFTR 

SUBROUTINE  CKFTR ( FN, CM, R , HM, NUNDTS , RKFSS »Q,UMt , UM2, 

1UM3,UN4,UMS,UM£, IRFM, XRHN, ICGM.Fg, HE, SN, ICBN ) 

C  CALLING  PROCRAH  MUST  SUPPLY  EIGHT  UORK  SPACE  ARRAYS 

C 

CTNIS  ROUTINE  CALCULATES  THE  KALMAN  FILTER  GAINS  WHEN 
C  GIVEN  THE  FN.Hfl,  CM  AND  R  MATRICES  AND  THE  NUMBER  OF 
C  DETERMINISTIC  STATES.  THE  CONTROLLER  MODEL  MUST  BE 
C  SPECIFIED  SUCH  THAT  ALL  THE  DETERMINISTIC  STATES  APPEAR 
C  FIRST  AND  TOGETHER,  THAT  ISe  r„- 

CD/-DT<Xt,X2,...XK,XL,X«,.,.XH)T^l  8H 

c  Iso  P^Lea/1 

C  WHERE  Xt  THROUGH  XK  ARE  THE  DETERMINISTIC  STATES  AND  THE 
C  REMAINING  STATES  ARE  STOCHASTIC.  FI  IS  K  X  K.  AND  F2  IS  H-K  X 
C  N-K,  AND  B1.B2.AND  G2  ARE  PARTITIONED  ACCORDINGLY. 

C  THIS  ROUTINE  FIRST  STRIPS  OFF  THE  DETERHlHSTlC  STATES  THEN  COMPUTES 
CAND  RETURNS  KALMAN  FILTER  GAIN5F0R  THE  REMAINING  STATES. 

C  THE  KALMAN  FILTER  GAINS  FOR  THE  DETERKlNSTIC  STAES  ARE  SET  TO  ZERO 
C  AND  THE  KALMAN  FILTER  GAIN  THAT  IS  RETURNED  IS  0 
C 

C  WHERE  THE  DIMENSION  OF  THE  ZERO  VECTOR  IS  K  AND  THE  RKFSS  IS  THE 
C  STEADY  STATE  KALMAN  FILTER  GAIN  MATRIX  FOR  THE  N-K  STOCHASTIC  STATES. 

C  THIS  AUGMENTED  MATRIX  IS  RETUTNED  IN  RKFSS 
C  ALSO  NOTE  THAT  IN  ORDER  TTO  GENERATE  THE  KALMAN  FILTER,  ONLY 
C  MEASUREMENTS  OF  STACHASTIC  STATES  ARE  NEEDED  SO  THE  H  MATRIX  IS 
C  REDUCED  ACCORDDINCLY. 

CHARACTER  MSCXM.MSGm 

DIMENSION  F2(NDIM,NDIM),HE(NDIM,NDIM),FfUNDIM,NDin),CM(NDIM,HDIM), 

1  RtNDIN.NDIN ) ,HMt  ND IN, NDIM  >, UNI  INDIA, NDIM  ),0< NDIN.NO IN ), 

1  WN£( NDIN.NDIN ),WN3( NDIN.NDIM) ,UM4(NDIM,NDIM ),UM5(NDIN, NDIN ) 

1  , UN6CNDIN.H0IN ) 

REAL  RKFSS CNDIM, NDIM ) , BMCNDIM.NDIM  > 

dimension  conun.conaui 

COMMON  /MAIHg/COHg 
COMMON  /MAIN  l/TCDIN.NDIMl,  CONI 
COMMON  /  INOU/  KIN.KOUT.KPUNCH 
COMMON  /MAUNS'  MSG 

CtKKKALMAN  FILTER  STEADY  STATE  GAIN - MODULE  »  2 

C  RKFSS*  t PASS  XHNT  XRI ),  WHERE  PN  IS  THE  STEADY  STATE  SOLUTION  TO  TH 
C  RICCATI  EAUATION  D(PN  )/DT »FN(PN (♦PN(FNT )»CR(Q ) tCNT )- 
C  PMtHNTXRI  XHNXPN) 


r 


XXZZZXZDELETE  DETERMINISTIC  STATES,  AND  - TRANSPOSE  THE  Fg 

MATRIX  FOR  THE  RICATTJ  SOIUER  SINCE  IT  TRANSPOSES  THE  CALLING  ARRAY> 
URITE<KOUT,x ) ' IF  YOU  PLAN  TO  USE  THE  DOYLE  AND  STEIN  TECHNIQUE  FO 
IR  THIS  RUN  YOU  NAY  UISH  TC  MODIFY  THE  VALUE  OF  NUMDTS,  THE  NUMBER 
I  OF  DETERMINISTIC  STATES.  DO  YOU  WANT  TO  CHANGE  NUMDTS?  Y  OR  N 
l>* 

READ (KIN, II )ASCi 
NUMSAV • NUMDT S 
IF  (MSGI.EQ. 'Y*  >  THEN 

WRITEUOUT.XJ  ‘ENTER  THE  NEW  VALUE  OF  NUMDTS  FOR  THIS  RUN>* 

READ ( KIN, X)NUMDTS 
END  IF 
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i 


« 
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IDS-NUNDTS+l 

CO  2112  1-IDS. IRFN 

Il-I-NURDTS 

DO  2112  J-IDS.IRFN 

JJ-J-NUNDTS 

2112  f-2UJ.II 

IRF2- IRFN-NUNDTS 
DO  2113  “I -1,  IRHN 
DO  2113  J-IDS.IRFN 
JJ-J-NURDTS 

2113  H2(l.JJ)-HRtI.J) 

C  NOLI  FORN  82, C2 

DO  £114  I-IDS.IRFN 

II-I-NUfOTS 

DO  2114  J-l.ICGN 

2114  uni(Xi.J>*enu.j) 

C  URl  -C2  1RF2  x  icon 
DO  2115  I-IDS.IRFP1 
II-I-NUKDTS 
DO  2115  J-i.ICBN 

2115  WN4(II, J)«BN<1.J> 
c  ufi4  -82  irf2  x  :cbn 

IRH2-1RHN 

CALL  HAT31 IRF2 ,  ICGN.UN1  ,G,UH2  > 

C  ur.2.Cr,(0)(GI«)  IKF2  X  IRF2  — USED  AS  'G'IN  KLIENNAN  RICCATI  ROUTINE 

URITEdCOUT.*  )'DO  YOU  UISH  TO  NODIFY  0  BY  THE  DOYLE  AND  STEIN  TECNI 
10UE.  Y  OR  N>' 

READ  CKIN.mnSCl 
11  FORNAT  <  A 1 ) 

IF  CNSG1.E0. 'V' !  THEN 

CALL  DAS 1 <  UN2 , UN4 , UNI , lCBfl, WR3, IRFN ) 

END  IF 

NT-1 


CALL  ECUATEU'N1.R,IRH2,IRH2) 

C  GNINU  DESTROYS  THE  CALLING  ARRAY 

CALL  GN.I  NU ( IRH2, I RH2, UN1,UN3,NR, NT ) 

IF  (NR.NE.IRH2)  THEN 

URITE ( KOUT . x ) ' NR- ' . NR , ' IRH2- ' , IRH2 

URITE(KOUT ,*  )  'R-INUERSE  IS  FOULED  UP' 

END  IF 

C  UN3-  RI  IRH2  X  IRH2 

CALL  TRANS2< IRH2, IRF2.H2.UN4 ) 

C  UfM-  H2T  IRF2  X  IRH2 

CALL  NAT  1  ( UR4 .  LT13 . 1 RF2 , 1 RH2 , 1 RH2 ,  UR5  ) 

C  UN5-  H2T(RI)  IRF2  X  IRH2 

CALL  NAT1 (UN5.H2, IRF2, IRH2, IRF2.UN3 ) 

C  UN3-  H2T(RI)(H2)  IRF2  X  IRF2 

CALL  NRICtIRF2,F2,Un3,UN2,UNB,WN4  5 
C  NOU  CALL  RICCATI  EQUATION  SOLUERTO  GET  PflSS 
C  UN6-PNSS  IRF2  X  IRF2 

CALL  NAT 1 ( UN6 , URS , IRF2, IRF2, IRH2.UN1 ) 

C  UN1-RKFSS  IRF2  X  1RH2 

10- 5 

C  FORN  RKFSS  WITH  ZEROS  ADDED  FOR  DETER.  STATES. 

PRINT*.  'NUNDTS- ' .NUNDTS 
IF  ( NUNDTS. HE. • >THEN 
DO  2118  J-l.IRHN 
DO  2118  1*1, NUNDTS 

2118  RKFSS(i.J)-» 

DO  2119  I  -IDS,  XRFN 

11 - I -NUNDTS 

2119  RtCFSS(I.J)-WNl(i:.J) 

ELSE 

CALL  E QUATE( RKFSS. WN1, IRFN, IRHN ) 

END  IF 

.  NSG- 'STEADY  STATE  KALMAN  FILTER  GAIN  MATRIX, RKFSS ' 
CALL  NNATIO(RKFSS.IRFN, IRHN, 10, KIN, KOUT, NDIN.NDIN) 
NUND’S-NUNSAU 
C 

END 

XDECK  FRNAUC 


C 

c 


SUBROUTINE  FRNAUC t Q,R, FT , ET , GC2.HT, GCX, BCZ,FC,CCV,BCY,GT,XC,PO, 
I  FA, BA, GA.GA, GUA.UN1 , UN2, UNA, UNS ,UNC, UMD, UKE.UHP, 

1  NXA , PXA , RA , PXUA , GC2A , IRY , I F  U.CZ , I F  LGSD ) 

THIS  ROUTINE  FORNS  A  SET  OF  AUGNENTED  NATRICES  NEEDED  BY  THE 
PERFORNANCE  ANALYSIS  ROUTINES 

DIMENSION  Q ( ND I N, NDIN ), R < ND 1 N, NDIN ), FT ( NDIN.NDIN ) 


/ 

/ 

/ 
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l.BT<NDin,NDIH>.GC2(NDin,NDlHJ,HT<NDIH,NDin>,CCX(HDIH.NDIH), 
l  BC2<NCtn,NDXH>,FC(NDIH,NDIH5.BCY<NDin»NDIH).CT(NDIH.NDin>. 

1  X0<NDin>,P0(NDIH,NDin),uni<NDin.NDIH),UN2<NDin,HDIH) 

DIHENSICN  FACNDin2.NDin2),BA(NDIH2.NDIH2),GA<NDIH2.NDIH2). 
i  0A(NDir2,NDir,2),unA<NDiN2,NDiH2),unB<NDin2,NDin2>. 
l  imc(NCin2.MEin£>,unD<HDin2,ND:n2).unE(HDinE.MDin2),unF 

1  <NBIH,NDini,GCYCNDIH.NDIH).PXA<NDIH2,NDin2>,RA<NDIH2,NDIH2), 

1  -CC2A(NDIH2.NDIH2  ),PXUA(NDIH2,NDIN2 ),GUA(ND1H2,NDIH2 ) 

REAL  hxa<ndih2) 

INTEGER  IFLGC2 

CHARACTER  NSGXGO 

dihension  conid ).con2(i> 

cohhon  /nAiH4/MDin2,NBin3 

cohhon  /hain2/coh2 

connow  /hAiNi/NDin.MDini.cont 

COHHON  /  INOU/  KIN.KOUT.KPUHCH 

cohhon  /hauhs/  nsc 

COHNON  /HAING/  ICBT, ICBH, ICFa, ICGA, ICGfl, ICGT , ICQA, IRFA, IRFN, IRFT, 

I  IRHT, IRQA, 10. LOC.IRHH.NUHDTS 

URITECKOUT,*)'  ENTER  A  5  IF  YCU  UANT  ALL  THE  AUGHENTED  HATRrCES  PR 
IINTED  OUT,  A  6  FOR  HO  hATRICES  TO  BE  PRINTED)' 

READ<KIN,X)IO 
IRFA- IRFT4 IRFN 
NSAUl-NDIH 
NSAV2-NDIH1 
NSAV3-NDIH2 
NSAU4-NDXH3 
C 

ClttFORH  AUCHENTED  HATRICES  THAT  ARE  REQUIRED  WHEN  FORMN5  XA 
UA* (UT  VT)T  IH»LIES  THAT  QA*  Q  9 


FORH  OA  IRQA  X  IROA,  IROA-IRWT+ICCH 
FOR  EOUIUALENT  DISCRETE  TIRE  SYSTERS  IRQA-  IRFT+IRHT 
IF ( IFLGSD.EG.e  )TH£N 
IRO-ICGT 
ELSE 
IRQ- IRFT 
END  IF 

DO  2703  I-l, IRQ 
DO  2703  J-l.IRHT 

2703  UHl<I,J>-0 

-DO  2704  I-I.IRHT 
-DO  2704  J-l.IRQ 

2704  UH2 ( I , J  )  • 0 
IFORH-1 
NDIH3-NSAV3 
NDH12-NSAU1 

CALL  AUGHAT(UH2,R,WHD, IFORH, IRKT , IRQ, IRHT, IRHT ) 
CALL  AUGHAT (Q,UHl,UHC, IFORH . IRQ , IRC . IRQ, IRHT 4 
IC0A-IR04IRHT 
IROA-ICQA 
IFORH-2 
NDIH2-HSAU3 

CALL  AUCHAT(UHC,UnD,QA, IFORH, IRQ. ICQA, IRHT, IRQA ) 
HSG-'  THE  AUQHENTED  0  nATRIX  IS  ,OA' 

CALL  HHATIO ( OA . IROA , IROA , 10 , KIN, KOUT , NSAU3 , NSAU3 > 
IHA-NSAU3-IRFT 

C  INITIALIZE  PXA  HXA  AND  STORAGE  VARIABLES 
DO  5105  IHXA-1,NSAU3 
5105  HXAt IHXA )-0 


DO  6100  IHXA* 1 , IRFT 
5100  HXA( IHXA  >-XO( IHXA ) 

HSG-'  THE  INITIAL  XA  VECTOR  IS' 

CALL  HUECIOfHXA, IRFA, 10, KIN, KCUT.NSAV3) 
nft  KiAi  TPXA-l.IRFT 


SI  92 
5101 

5103 


i  5102  JPXA-l.IRFT 
lAIIPXA,  JPXA  )-PO(  IPXA,  JPXA  > 
i  5101  JPX-l.IHA 
’XA- JPX*IRFT 
tA<  IPXA,  JPXA  >-0 

>  5103  IPX-1, 1 HA 
*XA-  IPX+-IRFT 
)  5103  JPXA- 1 , IRFA 

^^PtheJintitial  COVARIANCE  HATRIX.  PXA  IS' 

4LL  HHATIOIPXA, IRFA, IRFA, 10, KIN , KOUT , NSAV3 , NS A V3  > 
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CXXXPXUA  CALCULATION -  REQUIRED  ONLY  FIRST  TIME  THROUGH  LOOP 


6014 


SC  13 


6015 


PXUA 


,  5TfCC2)  „ 

1/2  „  -  R 


8C1 

TO  USE  THE  KLIENMAN  MULTIPLY  ROUTINES  ,  THE  DECLARED  DIMENSION  OF 

ARRAY  ARGUMENTS  MUST  BE  THE  SAME.  THEREFORE  IT  IS  NECESSARY  TO 
FORM  GC2A  SUCH  THAT  GCZAC I , J >«CC2C I , J >  FOR  I-l.IRHT,  AND  J*l, 

*■  ICBM.  AHD  2ER0  ELSEWHERE 
THE  "SAKE  REASON  REQUIRES  CALCULATION  OF  RA 
IT-MSAU3-IRHT 
JT-NSAU3-ICBM 
DO  6013  IC'l.IRHT 
DO  6014  JG*1 , ICBM 
GCZAC IC, JG  >«GC2( IG, JG ) 

DO  6013  JGM.JT 
JCA-ICBM+JC 
CC2AOC.JGA>»0 
DO  60 IS  IG*1, IT 
ICI*IC«-IRHT 
DO  6015  JG«1,HSAU3 
GCZAC ICI,JC>.0 
IR»NSAU3-IRHT 


DO  601?  IRl*l.IRHT 
DO  6017  JRI-I.IRHT 
601?  RACIRL.JRD.RCIRI.JRI) 

DO  6016  JRD1.IR 
JRJ.JRDIRHT 
6016  RACIRI.JRJ  1*0 

DO  6018  IR1 • 1. IR 
IRII-IRDIRHT 
DO  6ei8  JRI • 1 , NSAU3 
6018  RACIRII.JRD'O 

C  RA  •  R  IM  UPPER  LEFT  PARTITION. ZERO  ELSEWHERE 
IFC  C  IFLCCZ.  EG .  C  ) .  AND  •  C  IF’lCSD  .  EO.  C  )  >  THEN 
C  CALCULATE  PXUA  ONLY  FOR  CC2  NOT  EQUAL  TO  ZERO  MATRIX  AND  NOT  FOR  S-D 
C  RECALL  THAT  CBTCCC2)  BC2  >T  IS  THE  RICHR  PARTITION  OF  CA 
DO  6000  IPXA-l.IRHT 
IPA-IPXA+ICCT 
DO  6000  JPXA-l.IRFA 
6000  PXUACJPXA,IPXA).GACJPXA,XPA> 

Cl-.s 

NDIM-NSAU3 

-NDIMI-NSAC/3+1 

.CALL  SCALECUM?, PXUA, IRFA, IRHT, Cl ) 

CALL  MAT1 cur" .RA. IRFA, IRHT, IRHT.PXUA ) 

C  FUXA-PXAUT  IRFA  X  IRHT 

MSG*'  CROSS  COUARIANCE.  PXUA  IS' 

CALL  MMAT 10 C PXUA . I RFA , IRHT . 1 0 , K IN . XOUT , NSAU3 . NSAU3 ) 

END  IF 
C 
C 

C  FA-  FAll  FA12  .FT+BTCCC2 ) CHTF  BT(CCX) 

C  *FA21  FA22  .BCZCHT)  '  FC 

C 

C  WHERE  CCZ  IS  THE  CAIN  MATRIX  THAT  ACTS  DIRECTLY  ON  THE  MEASUREMENT 
C  UECTOR,  AND  GCX  IS  THE  GAIN  MATRIX  THATS  ACTS  ON  THE  CONTROLLER 

C  STATE  ESTIMATES. XXXXXTHESE  MUST  BE  SUPPLIED  BY  THE  CAIN  MATRIX 

C  ROUTINE - C 

C 

CXXXFORM  FA 

NDim-NSAUDl 

NDIH-MSAUI 

C 

CALL  MAT1 ( BT ,CCZ, IRFT , ICBT , IRHT, WM1 ) 

C  wm-BTCCCZ)  IRFT  X  IRHT 


CALL  NAT1 CUM  l ,HT, IRFT, IRHT, IRFT , UKZ ) 

C  UM2*  BTCGCZ  >HT  IRFT  X  IRFT 

ci*i.e 

-  CALL  MADDICIRFT,IRFT,FT,WM2,UM1.C1 ) 

C  WMl •  FAll  IRFT  X  IRFT 

IF  (ICBM. NE. ICBT  ITHEN 

WRITECKOUT.x >' ICBM- '.ICBM,'  ICBT«',ICBT 

WRITECICOUT,  X )  'BT  AND  BM  ARE  NOT  THE  SAME  SIZE-  WILL  CAUSE  ERRORS' 
m  END  IF 

▼  CALL  MATICBT, OCX, IRFT, IC8T,IRFr.,WM2) 

C  WMc»FAl2  IRFT  XtRFM 
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IFORM* 1 
MDIM2-NSAU1 

r  „„„  ^LL AUCNAT<UMI,UM2,UMA.IF0RM.IRFT,IRrT,IRFT.IRFH> 
C  U.MA*  t FA1 1  FA12 )  IRFT  X  IRFT*IR'K 

t  U!..-cfik"*Tiifg2-ST-  !£?-  ,S"T-  1SF"-“"'  > 

ND1M2*NSAU3 

IFORM-2 

IRFA-IRFT+IRFM 

1CFA-IRFA 

CAUL  AUCPIAT ( UM A , UMB ,  FA .  IFORM ,  IRFT  ,  IRF A .  I RFM.  ICF A  ) 
«SC- 'THE  AUGMENTED  F  MATRIX  FA  IS' 

_  ^  C?t!r  ™WTlOtFA,IRFA.IRFA#IO,K:M,KOirr#HSAU3,MSAU3> 

C  FA  IRFA  X  IRFA 
C 

CXXTFORM  BA  -  -  -  FOR  REGULATOR  CASE  ,  NOT  REQUIRED  Y*6 
CALL  MAT1 (BT.GCV. IRFT. ICBT. IRY.UM1 ) 

C  UM1*  BT(GCY)  IRFT  X  IRY 
IFORM*2 
NDIM2*MSAUi 

CALUAUCMAT^  ur.l ,  BCY, BA,  IFORM,  IRFT,  IRY,  IRFM,  IRY ) 
MSG*'  THE  AUGMENTED  B  MATRIX  BA, IS' 

CALL  HMATIOtBA, IRFA, IRY, !0,K!N,K0UT,NSAU3,NSAU3) 

C  BA  IRFA  X  IRY 

CALL  AUCMAT<UM1 , BCY.BA, IFORM, IRFT, IRY, IRFM, IRY ) 
MSG*'  THE  AUGMENTED  B  MATRIX  BA, IS' 

CALL  MMATJOCBA,IRFA,IRY,I0,KIN,K0UT,NSAU3,NSAU3) 

C  BA  IRFA  X  IRY 


w 


C 

CXSXFORH  GA 

C 

C  CA*  CT  BT(CCZ> 

C  •  •  BCZ 

C 

CALL  MAT1 1  BT,CCZ, IRFT, ICBM, IRHT.UMl ) 

C  WM1*  BT(GCZ)  IRFT  X  IRHT 
IFORM* 1 

-  CALL  AUGMAT(GT,UMI,UMC, IFORM, IRFT, IRQ, IRFT, IRHT) 

C  RECALL  IRQ* ICGT  FOR  CONTINUOUS  SYS, -IRFT  FOR  S-D  SYS 
C  UMC*  <GT  BTtCCZn  IRFT  X  IRHT*IRQ 
DO  3BC1  IR*1, IRFM 
DO  3061  IC* I , IRQ 
3CSI  UMKIR,IC)-e 

CALL  AUCMATfUMl ,BCZ,UMD, IFORM, IRFM, IRQ, IRFM, IRHT ) 
C  UMD-IO  BCZ I  IRFM  X  IRQ* IRHT 


ICGA-IRQ+IRHT 

IFORM*2 

C ALL^ AUGM AT ( UMC , WMD , GA , IFORM, IRFT, ICGA, IRFM, ICGA  > 
MSG*'  THE  AUGMENTED  C  MATRIX  GA  ,  IS' 

PA!  1  HHAT I O  C  G  A .  I RF  A .  I CCA . 10 . K IN . KOUT . NSAU3 . NSAU3 ) 


C  GA  IRFA  X  ICGA 
C 

C  GUA*GCZ(HT )  GCX) 

NDIM*MSAU1 

NDIM1*NSAU1*1 

CALL  MATt ( GCZ,HT, ICBT, IRHT , IRFT,UM2 ) 

C  UM2*  CCZ!HT>  ICBT  X  IRFT 
IFORM*! 

NDIM2*MSAUi 

HLir.3*NSAU3 

CALL  A'JGMAT<ur,2,CCX, CUA,  IFORM,  ICET,  IRFT,  ICBM, IRFM) 

MSG* 'THE  AUGMENTED  MATRIX  CUA  IS' 

CALL  MMATIOCGUA,  ICET,  IRFA,  I0,IC:N,K0UT,NSAU3,HSAy3  ) 

C  CUA  ICET  X  IRFA 

Ci set Zt AUGMENTED  SYSTEM  MATRICES  NOU  AWAILBLE  FOR  COMPUTATION 
C 


NDrM*NJAUl 
NDIM1 »NSAU2 
NDIM2*NSAU3 
NDIM3*NSAU4 
END 

DECK  SUBROUTINE  PERFAL( IRY, IFLGCZ,MXA,GCY , QUA.PXA.PXUA, IFLCSD, 

1  RA ,  CCZA ,  YD ,  E  AT ,  I  NT  GA  ,  UME ,  WMF ,  »UU ,  UM 1 ,  P.UOUT  ,  MXTOUT ,  PUO’JT  PXTOJT 
!  MXAMIN,MXAMAX,PXTP,IN,PXTMAX,Ms)MIN,MUMAX,PUMIN,PUMAX,MJ,  iNTBA, 
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1  UU3.UU4 ) 

CHARACTER  HS&*66 

REAL  UMl<NDIH,NDin).EAT 


1  NDIM), INTBA<ND1H2,NDIH2  ) 

oimInIionFccmiu  ).con2(i ) 

COMMON  /HAiN4/NDlM2,MDIH3 
COMMON  /BAXN2/C0M2 

85®  T^rMKU^H 

is  ass;  58t.i«2.i<« 

1  IRMT,XRQA,IO,LOG,IRHM.WNDTS 
NSAVt-NDIM 

nsau2«ndimi 

NSAU3-NDIM2 

NSAV4-NDIM3 

C 

cmispepporhance  analysis  routine  . 

c  this  IS  a  CONTINUOUS  TrnE  MEASUREMENT  PERFORMANCE  ANALYSIS 
C  ROUTINE  FOR  EUALUATIHG  CONTINUOUS  TINE  CONTROL  SYSTEMS  DRIVEN  BY 
C  UNITE  GAUSSIAN  NOISE.  IT  COMPUTES  THE  KEAN  AND  COUARIANCC  OP  THE 
C  OP  THE  TRUTH  MODEL  STATES  .THE  CONTROLLER  STATES, AND  THE  CONTROLS 

C  GENERATED.  A  SET  OP  AUGMENTED  MATRICES  IS  USED  TO  DO  THE 

C  CALCULATIONS - Y-(XT  USTARJT.  XA’-tXT  XH  >T  ..  -THE  PERFORMANCE 

C  ANALYSIS  ROUTINE  IS  DEVELOPED  IN  A  MASTERS  THESES  FOR  AIR  FORCE 

C  INSTITUTE  OP  TECHNOLOGY  BY  ERIC  LLOYD,  TITLE  'ROBUST  CONTROL 

C  SYSTEM  DESIGN' 


CXXtMXA.PXA  CALCULATION -  THE  mean  AND  COUARIANCE  OF  THE  XA  VECTOR 

C  FOUND  USING  SOLUTION  FORMS  OF  THE  PROPAGATION  EOUAtONS 

C  ~  KLIENMAN  ROUTINES  ARE  USED  TO  PROVIDE  THE  SOLUTIONS 

C  IN  TRE  FOLLOWING  TUO  EQS.  THE  FIRST  OCCURRANCE  OF  PXA  OR  BXA 

C  IS  THE  UALUE  AT  TIME  T+DELTIM,  THE  SECOND  - AT  TIME  T 

C  PXA-EATCPXA5EATT+INTCA 

C  HXA •  £  AT  C MXA I + INTBA 

C  SEE  DEFINITIONS  BELOU  FOR  EAT  .INTGA.  INTBA 

C 

C  NOTE  SINCE  THIS  PROGRAM  CONSIDERS. ONLY  THE  REGULATOR  CASE, 

C  Y-  THE  DESIRED  INPUT-  IS  ASSUMED  *  2ER0 


MXAO*(E(XO)  «)T  -(XO  6  )T 

pxao-  po  e 

i  e 


E-THE  EXPECTED  VALUE  OPERATOR 


EAT*  EXP (FAXTIME) 

INTBA-  INTEG<EAT)BA  FOR  CONTINUOUS  TIME  SYSTEMS 
•  BAD  FOR  DISCRETE  SYSTEMS 

INTGA-  INT(EAT(GA)OA(GAT)EATT  J  FOR  CONT  TIME  SYSTEMS 

■  CDa(ODA)GDAT  FOR  DISCRETE  TIME  SYSTEMS 

LCCUNT-B 

IRN-NIKT<RNTIME/DELTIM ) 

WRITE (KO’JT.t  ('ENTER  A  C  IF  YOU  WANT  NO  PRINTS  OF  PXA.  PUU,  MXA, 

\  AND  HU  MATRICES  DURING  THE  PERFORMANCE  ANALYSIS,  ELSE  ENTER  *HE 
i  NUMBER  OF  TIME  INCREMENTS  EETUEEN  PRINTS (  THERE  ARE  ' , IRN, '  TOTAL 
l  TIME  INCREMENTS  IN  THIS  RUN)>' 

READCKIN,* UPCHTL 
IF  (IPCNTL.EO.e)  THEN 

lo-e 
ELSE 
10-5 
END  IF 

DO  SB63  IN-i.NSAVl 
PUU( IN, IN  )-B 
MU( IN  )*B 
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t 


f 

I 

I 


f 


f 


I 


* 


rxaiiin<in>*« 

nxANAXUNee 

pxtnin<in>»« 

PXTNAX<IN>'0 

nuniNiih)»e 

nutwxd^j-e 

pimAxaN>»e 

PUMNCN)** 

SPP3  CONTINUE 

URITE(KCUT,X ) 'ENTER  THE  NUNBER  OF  SAH»LE  FERIODS  DESIRED  BETUSEN 
1  PLOT  POINTSfUAX  1000  PLOT  POINTS)  THERE  ARE  ',IRN,‘  SANPLE  PERIOD 
IS  REQUESTED  FOR  THIS  RUN> ' 

READ (KIN, X )IFLTPS 
DElPLT.DELTinxiPLTPS 
DO  5000  ITLHP«1.IRN 
C 

1F( IO.EQ.S )  THEN 

JJ-ITLHP-1 

IPNT  *  NOD ( J J , I  PCNTL ) 

IF(CIPNT.Ea.e).OR.<ITLnP.EG.rRN)i  THEN 

TINE-JJtDELTIPI 

URITE(KOUT,X ) 'TINE*  '.TINE 


HSG«'  -  PXA ' - 

CALL  NNATIO(PXA, IRFA, IRFA, I0,KIN,K0UT,N$AU3,HSAU3 ) 

nsc*'  puu' 

CALL  NNATI0(PUU,ICBn.ICEfl.I0,KIN,K0UT.NSAt'3.NSAU3) 
nSC-'NXA' 

CALL  NUECIO(XXA,  IRFA,  10, 1C  IN,  ROUT  ,NSAV3  > 

NSC*'NU' 

CALL  NVECIO(MU.  ICttl.  I0.K1N,K0UT,NSAUI ) 

END  IF 

c  nouDuant  to  store  for  plotting,  nxt,pxx,nu.puu 

DO  1E3  IUR-1.1RFT 
NXTOUT ( IUR )*NXA( IUR ) 

PXTOUT( 1UR  )*PXA( 1UR, IUR ) 

nxANiNi IUR  >*«iN(nxAniN< iur  >,nxa( iur  n 

NX ANAX ( I UR  > • H AX ( MXAA AX  < I UR ) . MXA ( IUR  >  > 

PXTNAXt IUR  )»NAX(PXTNAX< IUR ),PXA( IUR, IUR ) ) 

123  PXTNINilUR).«IN(PXTniNCIUR).PXA(IUR.IUR)) 

DO- 124  IUR-l.ICBN 
NJDUTUUR)-NU(IUR) 

PUOUT ( IUR )*PUJ( IUR, IUR  > 

funiN<  IUR  )-niN(HuriINc  IUR  ),ru(  iur  )  > 

HUHAXl  IUR  )  *NAX (HUNAX  (IUR  ) .  HU  ( IUR  )) 

PUr.AXt  IUR  )-r.AX(PUNAX(  IUR  )  ,PUU<  IUR,  IUR  >  ) 

124  PURINt IUR )*HIN(PUNIN( IUR ) , PUU( IUR, IUR ) ) 

cr*sxxXNO  CROSS  CORRELATION  TERNS  ARE  PLOTTED 


C 

NDIHG'NSAUl 

IPTCTL*N0D(JJ,1PLTPS) 

CAL^STORED  aOG.^NTIHE,  DELPLT,  LCOUNT,  IRFT ,  IRFT ,  ICBN, 1CBN, 
1  NXTOUT, PXTOUT,  WJOUT, PUOUT , NDIN6  5 

lcount«lcount*i 

C  NOTpTHAT  yd  is  restricted  by  value  of  lcount  to  be  constant 
C  BETUEEN  PLOT  POINTS 

IF  (LCOUNT .CT ,  IMS  )THEN 
C  RESET  LCOUNT 

lcount *ieee 

END  IF 

CXXXUPDATE  PXA.NXA 
C 


NDIM*N$AV3 

NDINl*NSAU34l 

CALL  NAT3( IRFA, IRFA, EAT, PXA, WNE) 

ci*i.e 

.  CALL  NADD1 (IRFA, IRFA.UNE, INTO A, PXA, Cl ) 
CXXtexA  AT  NEW  TINE  NOU  AUAILAELE 
C  NX A*  £AT(HXAC  )  +  INTEG (EATCiA ) XYP) 

DO  1814  IK*  1 ,  IRFA 
1814  UU3tIK)*e 

DO  1815  IK*1, IRFA 
DO  1815  IJ*1,IRFA 
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k  A 
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1815  UV3( IK )-UU3( IK  >*EAT( IK, IJ )XNXA( IJ ) 

CO  isle  IHR*1,IRFA 

1£  12  UV4(inR>*:NT8A<INR,l )XVD(LCOUNT) 

CO  1813  IJ»1,IRFA 
i £ i 3  nxA<:j>*uu3ciJ)+uu4(ij> 

CXXXNXA  AT  NEW  TINE  NOW  AVAILABLE 

CXXXHU.PUU  CALCULATION  FOR  ZERO  HEAH  MEASUREMENT  NOISE  „  _ 

C  HU*GUA<HXAJ4CCZ(HVT)+GCYCYD>....HVT  .THE  HcAN  OF  NOISE  V  ASSUMED  ♦« 

XI •VDCLCOUNT ) 

NDIN*NSAU1 
NCIIU-NSAWl  +  1 

CALL  SCALE (UNI ,CCV,  I  CBN,  IRV.Xl ) 

C  UNI*  GCVCYD  ICBN  X  l 

NDIN»NSAU3 
NDIN1 *NSAU3*1 
DO  181?  IJ* 1,1 CBN 
181?  UV3<IJ)*0 

DO  1816  IJ-l.ICBN 
DO  1816  IK-1, IRFA 

1816  UV3 ( IJ )-UU3< I J  >+GUA( I J. IK >XNXA< IK ) 

C  UV3-CUA(NXA)  ICBN  X  1 

C  ADDED  TO  UNI  ABOVE  TO  CET  HU 
DO  329  1*1, ICBN 
329  NU(I)-UU3(I  >«-UNl<L,l> 

c  nu  irfa  x  i  ~ - now  available - 

CXXXPUU  C ALCULAT ION, PUU •  CUA ( PX A  ICUAT+OUAt  PXVA  >GCZT*GCZ(PXVA>GUAT* 

C  CC2(R  JGCZT 

CALL  HaT3(IC8N, IRFA, CUA, PXA, PUU ) 

C  PUU-CUA(PXA)CUAT  ICBN  X  ICBN 
CXXXXXXIFLCCZXXXXX 

IF  (JFLCC2.E0.R)  THEN 

C  SINCE  CCZ  NOT  EQUAL  TO  ZERO  CALCULATE  OTHER  TERNS  OF  PUU 

CXXXXXXIFLCCZXXXXXX 


IF  ( IFLCSD.EQ.B)  THEN 
C  DONT  DO  THIS  FOR  S-D  CASE 

CALL  HAT1 ( CUA, PXUA, ICBN, IRFA,  JRHT, «NF  > 
CALL  HAT4(UNF.GC2A.ICBN.IRHT.IC8N,UHE1 

ci-i.e 

CALL  HADDK ICBN. ICBN, PUU. UHE.UHF.Cl) 

C  L'N^  •  CUA  ( PXA  )CUAT4-CUA(PXUA  JGCZT 

CALL  NAT4 (CCZA.PXVA, ICBN. IRHT, IRFA, PUU  > 
CALL  NAT 4 ( PUU, CUA .ICBN, IRFA , ICBN, UNE ) 
CALL  NADD1 (ICBN, ICBN, UNE, UNF, PUU, CD 
C  PUU • CUA ( PXA )CUAT+GUA ( PXUA  JGCZT -CCZ  ( PUXA  >CUAT 
END  IF 

CALL  NAT3CICBN. IRHT. CCZA.RA. UNE) 

CALL  NADD1 (ICBN. ICBN, UNE, PUU. UNF, Cl > 
CALL  EOUATE(PUU.UNF, ICBN. ICBN) 

END  IF 

CtXX  PUU  NOU  AVAILABLE  ICBN  X  ICBN 
C 


5v°*'  CAL^STOREDaOG.RNTINE.  DELTIN.LCOUNT,  IRFT.  IRFT.  ICBN.  ICBN. 

1  NXTOUT .  p*Tf^NUOUT  •  {WJT .  WWf^  pnCTOR  IN  2  LOCATIONS  FOLLOW  INC 

-  DATA  VALUES  --FOR  USE  IN  PLOT  ROUTINE 

C  NOTE  THAT  3.5  INCHES  IS  CHOSEN  HERE  AS  THE  AXIS  LENGTH 

CALL  STORED ( LOO. RNT INE , DELTIN . LCOONT .IRFT, IRFT .ICBN, ICBN, 

1  nXANIN.PXTNIN.NUNIN.PUrlN.NDINfi ) 

DO  125  I UR* 1 , IRFT 

r.XTOUTUUR  )•  (NXANAX(  IUR  )-NXANIN(  lUR  )  )X3.5 
Igc  PXTOUT( IUR  )• (PXTNAX( IUR )-PXTNIN( IUR ) >'3 .5 
DO  126  1UR*1 , ICBN 

NUOUT( IUR )-(HUNAX( IUR )-NUNlN( IUR  > )/3.S 

c  1  NXTOUT.PXTOU^HUOUT^PUOUTjNDINI^T  <  e  INDICATE  this  data  run  conplcte 

CALL^STORCD( LOO, RNTINC, DELTIN.LCOUNT, IRFT, IRFT, ICBN,  ICBN, 

1  NXTOUT , PXTOUT , NUOUT , PUOUT , ND I NS ) 

■  NDIN-NSAV1 
NDIH1 -NSPU8 
HDIN2*NSAV3 
NDIN3-NSAV4 


4* 


C  RESET  10  TO  SOME  NONZERO  VALUE  TO  AVOID  TERMINATING  THE  PROGRAM 
C  UHEN  RETURNING  TO  MAIN  ROUTINE,  LQGRP 
10*25 
END 

(DECK  MVPLOT 

SUBROUTINE.  HYPLOT 
END 

XDECK  AUCMAT 

SUBROUTINE  AUCMAT (  A1 , A2, A3, I FORM, IRA1 , ICA1, IRAS, ICA2 ) 

C 

cittTtNDiMe.Nrins  must  be  set  in  them  calling  program  before  using 

CXISSXNCIM2 , NCI M3  MUST  BE  SET  IN  THE  CALLING  PROGRAM  BEFORE  USING 
cxixtx  This  SUBROUTINE.  THEY  MUST  BE  DECLARED  IN  A  COMMON  BLOCK 
C  LABELED  — MAIN4 - 

C  THIS  SUBROUTINE  FORMS  AUGMENTED  MATRICES  OF  THE  FORM 
C  IFORfi'1  A3*  (Ai  A£) 

C  IF0RM»2  A3*tAl  AB)T 

C 

C  IRA1 , IRAS, ARE  ROW  DIMENSIONS, ICA1, ICA2, ARE  COLUMN  DIMENSIONS 

DIMENSION  AI(NDIM2.NDIM2),A2(NDin2,NDIM2),A3tNDlM3,ND:r.3) 
COMMON  /MAIM/HDire.NDIMS 
IF  (IF0RM.E0.1)  THEN 
C  FORM  THE  AUGMENTED  MATRIX  A3*(Al  A2 ) 

DO  12  II-l.IRAl 
DO  11  III  *  1 « ICA1 
11  A3(11.I1I>*AHII.III) 

DO  12  IU*1 , ICA2 
lUt*UHICAl 

10  A3III.IUI  )*A2(H,IU) 

RETURN 
END  IF 

C  FORM  AUGMENTED  MATRIX  A3*(A1  Ag)T 
IRA3*IRA1+IRa2 
ICA3-ICA1 
DO  14  II-1.ICA3 
DO  13  III-1.IRA1 

13  A3cni.m-AU2n,n> 

DO  14  1U*1, IRA2 
IV1-IV-HRA1 

14  A3(  IJJI ,  II  )*A£(  IU.  II  ) 

RETURN 

END 

1DECK  MVECIO 

SUBROUTINE  NVECIO(A,NUMEL,  IO,KIN,KOUT,NDIM  ) 

C  THIS  SUBROUTINE  READS  PRINTS  ENTIRE  (PORTIONS  Oe J  THE  VECTOR 

t  A,  DEPENDING  ON  THE  VALUE  OF 10 .  10*1 READ  ONLY 

C  10*2 - READ  AND  PRINT,  10*3  READ  SELECTED  VALUE ,  10*4 

C  PEAD  AND  PRINT  SELECTED  VALUES 
v  IO-S - PRINT  ONLY 

C  TO  USE  10*3  OR  4  THE  GASILINS  PROGRAM  MUST  INITIALZE  THE  UEC. 
t  xxxrxtTKIS  ROUTINE  SETS  10*0 -  WHEN  NO  DATA  IN  INPUT  FILE 

C 

CREAD  IS  FROM  UNIT  SPECIFIED  BY  CALLING  PROGRAM  IN  KIN. WRITE  15  TO 
C  KCUT.NDin  IS  THE  DECLARED  DIMENSION  OF  A  IN  THE  CALLING 
C  PROGRAM 

CHARACTER  MSCX68 
DIMENSION  A(NDIB) 

COMMON  'MAIMS'  MSG 
IF  ( ( IO.EQ .  t  ).0R. (I0.EC.2 ) )  THEN 
C  READ  ENTIRE  VECTOR 

URITE(KOUT.t) 'ENTER  ' .NJMEL, 'ELEMEMTS>' 
READtKIN,X.END*2SHA(I),l*l,HUnEL) 

END  IF 

IF  (I0.E0.1)  THEM 
RETURN 

C  RE AD^OnJy ' SELECTED ' ELEMENTS ! *  TH|NFIRSTNVMBER  ON  EACH  CARD 

C  IS  THE  SUBSCRIPT,  THE  SECOND  IS  THE  DATA  ENTRY 

**,»«  «*  m*i«  «  « 

c  w  Em,,Et  T0  ,E  MtE>' 
uriteckoutIx^Inter  The  element  number  .then  its  vaiuev 


,  -W*vV- 


TV*  ■ 


anonoo  o  n ^  c o r> 


c 

33 


R£aD<K:n.x,£nD*29)I. ENTRY 

A<I  GENTRY 

IF  < I0.EQ.4 )TH£N 

WRITE (FCUT, 33 ) '  • 

UfirT£CFOUT,Z)MSS 

UR ITE  (XCUT , x  ) 'ELEMENT  HUMBER 

URJTE£FOUT,  11)1, A(I) 

end  if 

26  CONTINUE 
RETURN 
END  IF 


ENTRY) ' 


IF  <CI0.ECl.2).OR.UO.EO.5>)  THEN 
TO  GET  HERE  10*2  OR  S  SO  PRINT  OUT  ENTIRE  VECTOR 
WRITE! FOUT, 33)'  ' 

WRITE  £KOUT,X)MSC 

URlTE£KOUT,x)'  THE  VECTOR  HRS  '.NUMEL.  '  ELEMENTS ' 
UR;TE£K0UT,22XAU).I-1. NUMEL) 

RETURN 
END  IF 
RETURN 

29  PRINT*.  'END  OF  DAT  REACHED  DURING  INPUT  IN  P1VEC10' 
10-6 


XZXXXXT+iIS  ROUTINE  SETS  10-6 - WHEN  NO  DATA  IN  1NPV  F1U. 

F0RNATIA16, /  ) 

II  F0RMATO4,  15X.E12.S ) 

22  F0RnATa6£16(lX,E12.6),»./)> 

RETURN 

END 


iDECK  NNATIO 

SUBROUTINE  MMA?10£A, IR, IC, IO,FIN,FOUT,NDZN,ND!M1 > 

CHARACTER  NSCX86 
DINENSION  A< NDIN, NDINl ) 

COMMON  /NAUN5/  MSG 

C  THIS  SUBROUTINE  READS  AND/OR  PRINTS  THE  MATRIX  A  DEPENDING  ON  THE 
C  VALUE  OF  10.  IT  READS  FROM  UNIT  SPECIFIED  BY  KIN  AND  WRITES  TO  UNIT 
C  FOUT.  IO-l— READ  EN1RE  ARRAY  10*2— READ  AND  PRINT  ENTIRE 

C 

C  ARRAY.  10- -3 - READ  SELECTED  ELEMENTS  OF  A  10-4 - READ  AND  - 

C  PRINT  SELECTED  ELEMENTS  OF  A  I0»5  - PRINT  ENTIRE  ARRAY 

C  aDln.NDIMl  ARE  THE  DIMENSIONS  OF  A  in  THE  CALLING  PROGRAM 

ZXZXXXNOTE  IF  10*3  OR  4  THE  CALLING  PROGRAM  MUST  INITIALIZE 
THE  ENTIRE  ARRAY  BEFORE  CALL 

ZZZZZZZTHIS  ROUTINE  SETS  10  *6  -  WHEN  THE  INPUT  FILE  IS  EMPTY 

IF  ((I0.EQ.1 ).0R. (IO.EO.2))  THEN 
READ  ENTIRE  ARRAY  IN  FREE  FORMAT, ROW  MAJOR  ORDER 

WRITE! FOUT,*) 'ENTER  \CIRXlO,'  ARRAY  ELEMENTS  IN  ROU  NAJ  ORDER > ' 
RE AD £ F IN, t, END *29  )<(Ad,J>,J*l,IC5,l*l,lR)  ' 

END  IF 

IF  (IO.EO.n  THEN 
RETURN 
END  IF 

IF  ( < I0.EG.3 )  .OR. £ IC.EG.4 ) )  THEN 
READ  IN  SELECTED  ELEMENTS  OF  A 

THE  FIRST  CARD  IN  THE  INPUT  STREAM  MUST  CONTAIN  THE  TOTAL 
NUMBER  OF  ELEMENTS  TO  BE  READ  IN.  ONLY  ONE  ENTRY  PER  CARD. 

THE  FIRST  ITEM  ON  EACH  CARD  IS  THE  ROW,  THESECOND  IS  THE  COL  THE 
LAST  OH  EACH  CARD  IS  THE  DATA  FOR  THA'/  LOCATION 
FREE  FORMAT  IS  USED 

UR I TE ( K OUT , Z ) • ENTER  THE  NUMBER  OF  ENTRIES  TO  8E  NADE> ' 

RE AD ( F I N . Z . END- 29 JNUMEL 
DO  26  1*1, NUMEL 

WRITE (FOUT. X ) 'ENTER  THE  ROU, AND  COLUMN  FOLLOWED  BY  ITS  VALUE) ' 
READ(CIN,Z.ENtl*eS)I2.J.  ENTRY 
Alll.J GENTRY 
IF  (I0.EQ.4)  THEN 
URITEOCOUT.33)'  ' 

WRITE (FOUT, t)MSG 

WRITE (KOUT ,X)'f',II,  *,J,  '  >•',*(! I, J) 

END  IF 
26  CONTINUE 
RETURN 
END  IF 

IF  <UC.E0.8).0R.  (10.E0.S))  THEN 
C  10  •  £  OR  S  !r  HERE  SO  PFJHT  ENTIRE  ARRAY 
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URITE<  KOUT, 33 ) '  ' 

UFTITEOCOUT.r  >HSC 

URITEUOUT,*)'  MATRIX  SIZE  IS  '.IR.'  X  MC 
DC  49  I  ■  1 , IR 

49  UFIT£lK:0UT,4S)(A(I,J),J.t.IC> 

33  FCRNAT< A18,/ ) 

48  FORpaTTSi  1C(1X,E12.6 ),  t ,  /  ) ) 

END  IF 
RETURN 

29  PRINT  1,  'END  OF  DATA  REACHLL  DURINC  IN^UT* 

C  txixtixTHIS  ROUTINE  SETS  iO  U>-'EN  THE  INPUT  FILE  IS  EM°TY 


io*e 

return 

END 

I DECK  CLOCRS 

SUBROUTINE  CLOGRSCCCSTR.Fn.BH.RKFSS.HM.CCX.GCV.CCZ. 

IBCV.BCZ.FC, YD.RM.QM.FT, BT.GT.GT , RT.HT, IRY, IFLGC2.UM1 

i  .wns.uns.PO.GN.uiw.ims.uiie, 
i  uui,uu2,uuu,uxx,xo,uxu.um7.uh8> 

C  THIS  ROUTINE  PERFORMS  SET  UP  FOR  USING  THE  CONTINUOUS  TIME 
C  PERFORMANCE  ANALYSIS  FOR  ANLOG  REGULATOR 

DireNSI0NGCSTR(NDIN.N2IM),FHtNDir,NDIH>,BH(NDIM.NDIH>.P0<NDIM. 
1NDIM  >,Mn(NDIN-,NDIN),CCX<NDIN.NDIM, ) , CCY( NDIM.HDin > .CCZCNDXM ,NDln > . 
lBCY(NDIM.NDin),BCZ(NDIM,NDIN).FC(NDlM.N0IH).VD(NDIP.3).UHl(ND:r.. 
lNDln).UM2(NDintNDir.),Ufl3(NDir;,NDin),FT(NDin,NDin), 

1  BTtNDIH.NDIM )  .GTINDIM.NDIM  )  ,HT  tNDIM.NDIN ),RM( NDIN.NDIM ) , 
lCT(NDIP!,NDin).RT(NDln,NDlr,  ),ON(NDir,NDIM>.UUl<NDtK>.UUcCNDin 
l  j,xotNDin>,CM<NDIM,NDlM>,uju:NDlM,NDin>, 

1  UXX(NDIN,NDIM  1  ,UM4<  NDIN.NDIM  ),UM5(NDIM,NDIH  >, 

1  UN6rNDin.NDIM>.WXU(NDIrt.HDir!),Wn?<NDIM,NDin),UM8(NDrn,NDIM) 
DIMENSION  COMK1  >,C0N2<1  ) 

CHARACTER  MSGXSe 
INTEGER  IFLGCZ 


REAL  RKFSSC NDIN.NDIM} 

COMMON  /NA1N4/NDIH2.NDIH3 
COMMON  /MAUN5/  MSG 
COMMON  /MAINl/  NDIM, NDIMl.COMl 
COMMON  /MAIN2/  COM2 
COMMON  ^RNTIM/'RNTIME.DELTIM 
COMMON  /INOU/  KIN.KOUT.KPUNCH 

COMMON  /MAIN6/ICBT. ICBM, ICFA. ICCA, ICCM. ICCT, ICCA, IRFA, IRFM,  IRFT, 

1  IRHT, IRON, 10, LOG, IRHM.NUMDTS 

III? I TE ( KOUT ,  *  ) '  DO  YOU  UANT  TO  CALCULATE  EICENUALUES  OF  THE  TRUTH  MO 
1DEL  AND  CONTROLLER  MODEL  F  MATRICES,  V  OR  N> ' 
R£AD<tClN,23»END*2933 )  MSG 
23  FORMAT (Al) 

IF  (MSG.EO. 'Y' )  THEN 
URITEOCOUT,*  >'  ' 

URITECKOUT.D'THE  EIGENVALUES  OF  THE  TRUTH  MODEL  F  MATRIX' 

CALL  HEIGNtFT.WVl.UVE.IRFT.UMl ) 

URITEOCOUT.D'THE  EICENUALUES  OF  THE  CONT.  MODEL  F  MATRIX' 

CALL  MEIGN(FM, UU1.WU2, IRFM, UNI  3 
END  IF 

CALL  CKFTR(FN,GM,RN,HM.NUMDT5,R<FSS,QN,UNl,un2,Un3,UN4,UnS,UnS, 

1  IRFM, IRHM, ICGM.GCY.GCZ.BM, ICBM ) 
r  ftCV  IN  CALL  TO  CKFTR  ARE  USED  AS  DUMMY  ARRAYS  FOR  H2  ,F2 

2CALL'CDTC0N (FM.BM.UXX.UUU.GCSTR, IRFM, ICBM, Uni,UM2,yM3.UM4,UnS,un6, 

^ITEUOUT?!)  'ENTER  THE  TOTAL  RUN  TIME  AND  THE  TIME  INCREMENT) ' 

RE AD ( K I N , * . END • 293 3 >RNT I ME . DELT IM 

CALL1 IDKTC IRFM. UNI ,C1 ) 

C  UM1*-I  IRFM  X  IRFM 

CALL  MATKGCSTR.UMl.ICBN.IRFM, IRFM, OCX) 

io*s 

MSG* 'OCX  FOLLOWS.  GCY.GCZ  SST*8 ' 

.  CALCULATED  IN 

C 


NOTE**!***  ° ' "L TH?S  *  MODULE  *  FOR  *  USE  *  INLINE " PERFORMANCE  ANAL YS IS  ROUT I HE . 
DO  2982  HI*  l,  ICBM 


DO  2902  mi*:, IRHM 

2902  CCZt II  1. 1111 )•* 

C  IFLGCZ* l "INDICATES  CCZ  IS  SET  TO  ZERO-PREF  ANALYSIS  ROUTINE  USES  IF 

C  DO  2983  I*!.!®*® 

2903  YD<D*e 
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IRY*l 

CO  1723  I-1.1CM 
60  1723  J»1,IRY 
1723  CCYU.J>*0 
C  FORM  BCY 

60  1702  I-l.IRFM 
60  1702  J.l.IRY 
1762  BCV(I,J)*0 

C  VFORMC2L°tEC  T°  °NLV  B£  *  ScftLAR  AT  THIS  TIME 
01*1.0  ‘ 

CALI  E OUATE ( BCZ . RKFS5 , 1RFM , I RHM ) 

MSG* 'BCZ  FOLLOU$,BCY*0 ' 

CALL  MnATI0(6CZ.  rRFM,  I RHM,  rG.KlN.KOUT.NDrM.NDIM ) 

C  FORM  FC 

CALL  MATl(Bn,CCX.IRFM,lCBn.IRFn,uni ) 

CALL  MADD1  ( IRFM,  IRFM,Fn,L'Hl,Un2,Cl  ) 

URIT£(KOUT,*)'  ' 

URITECKOUT,* )  'DO  YOU  UANT  TO  CALCULATE  THE  EICENUALUES  OF  THE  COST 
1INU0US-T1ME  LQ  CONTROLLER?  Y  OR  N>' 

RtAD<KIN,23 )MSG 

_  IF  (MSG.EQ.'Y')  THEN  _ _  _ 

WRITE  (KOUT,*) 'THE  EIGENUALUES  THAT  CORRESPOND  TO  THE  POLES  OF 
1  THE  CONTINUOUS-TINE  LO  CONTROLLER  ARE...' 

CALL  HE:CN(UM2,UUl.UU2,IRFn,UNl ) 

END  IF 
Cl  — 1 

CALL  MATT  (RKFSS",HM,  IRFM,  IRHM,  IRFM,UM1 > 

URITEUCOUT.*)'  ' 

UR I TE 1 KOUT , *  ) ' DO  YOU  UANT  TO  CALCULATE  THE  POLES  OF  THE  COHTINU 
10US-TIME  KALMAN  FILTER?  Y  OR  N> ' 

READ (KIN, 23 )NSG 
IF (MSG.EO. 'V '  )  THEN 
CALL  MIADD1  ( IRFM,  IRFM.FM.Ufli ,UM?,C1  ) 

URITEUCOUT,*) 'THE  EICENUALUES  THAT  ARE  THE  POLES  OF  THE  CNOTINU 
10US-TINE  KALMAN  FILTER  ARE....' 

CALL  nEIGN(UN7,UUl.UU2,IRFn,UIT8) 

END  IF 

CALL  MADD1  ( IRFM,  IRFM.UMc.UBl , FC,  Cl  ) 

HSC* '  FC  FOR  THE  LOG  CONTORLLER  IS' 

CALL  MMATIOCFC, IRFM, IRFM, 10, KIN, KOUT, NDIM.NDIM ) 

URITEUCOUT.*)'  ' 

URITEUCOUT, * ) 'DO  YOU  UISH  TO  CALCULATE  THE  EICENUALUES  OF  THE  L03  - 
1C0NTR0LLER  F  MATRIX’  Y  OR  N> ' 

RE&DUCIN.23  )PISC 
IF  (NSC.EO.'Y')  THEN 
URITEUCOUT,*)'  ' 

URITEUCOUT,*  )'THE  EICENUALUES  OF  THE  LOC  CONTROLLER  F  MATRIX  ARE' 
CALL  HEIGNCFC.UUl ,UU2, XRFM.UMl ) 

END  IF 
RETURN 
2533  10*0 

END 

*DEC«C  DAS1 

SUBROUTINE  DAS1 (GQGT, BM,U, ICBM.UM3, IRFM ) 

DIMENSION  GOGTt NDIM.NDIM ),BMCNDIM,N6IM),UtNDIM,NDIM), 

1  un3<NDir.,NDIM),C0Mia  ),C0M2(1)  _ 

C  THIS  SUBROUTINE  MODIFIES  COST  AND  RETURNS  TPE  MODIFIED 
C  UALUE  IN  COGT,  UHERE  COCT  IS  USED  IN  THE  KALMAN  FILTER 

C  CAIN  CALCULATIONS.  THE  MODS  ARE  IN  ACCORDANCE  WITH  THE 

C  THE  TECHNIQUE  DEVELOPED  BY  DOYLE  AND  STEIN  IN  ’ROBUSTNESS 
C  WITH  OBSERUERS * , IEEE  TRANS.  ON  AUTO.  CONTROL. UO I L  AC24, 

C  NO.  4, AUG.  79. PCS  607-611. 

C  THE  UALUE  RETURNED  IN  COST  IS  00  .  UHERE  OQ  IS 

C  OQ*GOGT+SQ(SQ )BM( UtBMT  ) 

C 

C  SO  IS  A  SCALAR  DESICN  PARAMETER.  THAT  AS  IT  APPROACHES 
C  INFINITY,  CAUSES  THE  LOC  C0NTR6LLER  TO  RECOUER  THE  ROBUSTNESS 
C  PROPERTIES  OF  A  FULL  STATE  FEEDBACK  CONTROLLER. 

CTHE  MATROX— U—  IS  ALSO  A  DESICN,  PARAMETER  WITH  THE  REQUIREMENT 

C  THAT  IT  BE  POSITIUE  DEFINITE.  BM -  IS  THE  CONTROLLER  MODEL  INPUT 

C  MATRIX.  COCT  — -  IS  THE  CONTROLLER  MODEL  INPUT  NOISE  STRENGTH 
C  MATRIX  OM,  PREP.ULTIPIED  BY  CM  AND  POST  MUTIPLIED  BY  CNT  UHERE  CM  IS 
C  THE  INPUT  NOtESE  MATRIX. 

CHARACTER  MSC*G0 

COMMON  /MA1N1/NDIM,NDIM1,C0M1 

COMMON  /MAINE/  COM2 

COMMON  /INOU/  KIN, KOUT, KPUNCH 

COMMON  /HAUNS/  MSG 

UR I TE (KOUT ,11)'  ' 

URITEUCOUT.*  > 'THIS  ROUTINE  MODIFIES  THE  UALUE  OF  GM(0M5C«T 
1  USED  IN  CALCULATING  THE  KALMAN  FILTER  CAIN,  RKFSS . ' 

WRITE  (KOUT.*) 'THE  MODIFIED  0  IS  •  GMl  On  )GMT*$Q*SO<»H  )U<BMT)U»CRE 
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/ 

I 

* 

I , 


# 


1  SO  IS  p  SCALAP  DESICN  PARAMETER- AND  U  IS  A  POSITIVE  OEF IHITE  _ 

1  MATRIX  DESICN  PARAMETER.  THE  LARGER  SO,  THE  MORE  ROBUST  TK_  CONTRO 
IL  SYSTEM  UILL  BE.' 

do  5  iNP«i,ieee 

UR  I TE ( KOUT ,  1 1  > '  ' 

11  FORMAT (A1C , / ) 

URITE(KOUT.X) 'ENTER  1-TO  INPUT  SO,  2-TO  IKPJT  U  3-  TOCALCULATE  MOD 
1IFIED  OQt  X-  TO  EXIT  THIS  ROUTINE) ' 

READOCIN,X)ISEL 
GO  TO  (1.2.3,X)ISEL 

1  WRITE (KOUT.il)'  ' 

URITECKOUT.* VENTER  SG>e— >' 

READ(KIN,X )SQ 

GO  TO  5 

2  MRITEOCOUT, It ) '  ' 

URITE  (ICOUT,X)'U  IS  INIALIZED  TO  .ZERO  UPON  ENTRY  INTO  THIS  OPTIO 
IN' 

DO  7  W.NDIH 
DO  7  J-l.NDIM 
7  VCI.J).® 

URITECKOUT,X) 'ENTER  I/O  OPTION  FOR  POSITIUE  DEF  UtSEE  INPUT  ROUT1N 
IE  )> ' 

READCKIN.X )IO 

MSC* 'DESICN  PARAMETER  U  MATRIX  ENTRIES' 

CALI  MMATIO+U, tCBMj ICBM, 10 , KIN, KOUT, NDIM.NDIM) 
j  CALL  MA73( IRFM, IRFM, BN,U,UM3 ) 

C  UM3*BM(U>BMT  IRFM  X  IRFM 
SOl-SOtSO 

CALL  MADD1 < IRFM, IRFM.COGT, UM3, U, SOI ) 

IRFM  X  IRFM  NOU  CONTAINS  THE  MOD.  UALUE  - QQ 

MSG* 'THE  DOYLE  AND  STEIN  MCDIFED  OQ  MATRIX  IS' 

IO-S 

CALL  MHATIO(U, IRFM. IRFM, 10, KIN, KOUT, NDin.KDIM) 

CONTINUE 
CONTINUE 

00  IS  ACCEPTABLE  SO  PUT  INTO  COOT 
DO  20  1*1, IRFM 

do  ee  j* i , irfm 

G05T(I,J).U<1,J) 
return 
END 

XDECIC  MYINTC 

rlvIf''T2<F’HI,  INTCA,  INTBa,WME,CA.OA,FA.BA.  IRFA,  ICCA,  IRY, 

c  THIS  SUBROUTINE  SETS  UP  THE  NECESSARY  INTEGRALS  FOR  USE  BY 
r  „  „  THE  PERPORMANCc  ANAL.  ROUTINE.  THE  STATE  TRANSITION  MATRIX. 

r  INTECtEATCGA,  OA  (GAT)  EATT )  AND 

c  INTECIEAT  (BAJ).  UME  IS  A  DUMMY  UORKAPAMF  ° 

DIMENSION  COHlU>.COMg(i  ) 

C0MMON/MAIN1/NDIM.NDIM1.C0M1 
COMMON/ MAINE/  COME 
COMMON  /INOU/  kin.kout.kpunch 
COMMON  /RNTIM/RNTIME.DELTIM 
COMMON  /MAINA/NDIM2, NDIM3 


C  U 


ee 


SXXFORM  GA(OA)GAT  —NEED*  FOR  KlIENMAN  ROUTINE 

NSAU1-NDIM 
NSAU2.NDIMI 
NDIM-NDIM2 
NDIMI •NDJMgTl 

UME  •  I  NT  ^E  AT 1 ) ' ” ' ‘ IRr  * ' ' ' F*'  DELT : 11 "*  1  N™ '  ,  I  e  ) 

J2?Jl£UEE '  BAt IRPfl'  IKPA.  IR*,  INTBA  ) 

INTBA*  INi(EAT)BA  IRFA  XIRY  NEEDED  IN  MXA  UPDATE 
CALL  MAT3aRFA,IR0A,CA,0A,PHI)  UPDATE 

PHI «GA (OA  ) (GAT )  IRFA  X  IRFA 

INTGA-INTECRAL  (  EXP  (FA  )( CA  )  (OA  )  (CATT  XEXP  (FA  )T  )  >  IRFA 

NDIM-NSAU1 

HDIM1-NSAV2 

RETURN 

END 


X  IRFA 


\ 

13,9 


N 


.  ( 


t 


9 


XDECK  DSCRTZ 

SUBROUTINE  DSCRT2  (Uf.l  ,PHIR,  BCYD.  BCZD,  IRFR,  DEtTIR.FC,  BCY. 

1  IRY.BCZ.XRHR.PHIT.QTD.BTD.GT.OT.FT.BT.IRFT.ICGT.ICBT.IRHT. 

1RTD, PT.GCX, ICBR  ) 

C  THIS.  ROUTINE  DISCRTIZES  A  CONTINUOUS  TIRE  IQS  CONTROLLER  USING 
C  FIRST  ORDER  APRROXIRATIONS  TO  THE  REQUIRED  INTEGRALS 
C  AND  PROVIDES  AN  EOUlUALENT  DISCRETE  TIRE  REPRESENTATION  OF  THE  TR-JTH 
C  MODEL  FOR  USE  IN  THE  PERFAL  ROUTINE 

REALUfll*.  (NDIR, NDIR), PHIR  (NDIR.NDIR), BCYD  (NDIR.NDIR), 

1  BCZD(NDIR. NDIR), FC(NDIR. NDIR).  BCY (NDIR.NDIR ), 

1  BC2 (NDIR.NDIR ) ,PH IT (NDIR, NDIR )  ,OTD( NDIR.NDIR ), 
l  BTD ( NDIR, NDIR  ), CT (NDIR, NDIR >.CT( NDIR, NDIR). 

1  FT(NDIR.NDIR),  BT (NDIR.NDIR) .RTD  (NDIR.NDIR). 

1  CCXtNDIR, NDIR), RT(HDIR. NDIR) 

REAL  COR1 ( 1 ),COR2( 1 ) 

CHARACTER  RSCX1 
CORRON/RAtNl/NDIR.NOIRl ,CORl 
CORRCN/RAIN2/  C0R2 
C0RR0N/RAIN4^ND1R2.NDIR3 
COR-I ON  /INOU/KIN.KOUT.KPUNCH 
Cl-t.0 

CALL  IDNTC IRFR.gm.cn 
CALL  IDNT< IRFR.URI .Cl ) 

CALL  RADDKIRFR,  IRFR.URI. FC.PHIR.DELTIR) 

C  PHIR«I*FC(DELTIR)  1ST  ORDER  APPROX  TO  STATE  TRANS  MATRIX  OF  CONT 
C  CALCULATE  G0X  •-CC9TR 
Cl  — 1.0 

C  RECALL  THAT  GCSTR  UAS  PASSED  INTO  THIS  ROUTINE  IN  BTD 
CALL  SCALEfCCX,  BTD.  ICBR.  IRFR, Cl) 

C 1*1.0 

CALL  SCALE(BCYD, BCY, IRFR, IRY.DELTIR ) 

C  BCYD  DISCRETE  TIRE  APPROX  OF  BCY 

CALL  SCAL£(BC2D,BCZ, IRFR, 1RHR.DELTIR) 

C  BCZD  DISCRETE  TIRE  APPROX  OF  BC2 
NSAV3-NDIR2 
NDIR2-NDIR 

CALL  RYINTC(PHIT,0TD,BTD,UR1,CT, QT, FT.BT , IRFT, ICCT, ICBT,  IRHT ) 
NDIR2-NSAV3 

C  PHIT.QTD.BTD  ARE  EOUIV.  DISCRETE  TIRE  REPRESTATIONS  OF  TRUTH  RODl 
C  RATRICE 

URITEOCOUT.X )'  ' 

URITE(KOUT.X)'  UAS  THE  VALUE  ENTERED  IN  RT  DURING  INPUT  A  CONTINUO 
1US  TIRE  OR  A  DISCRETE  TIRE  VALUE?  ENTER  A  C  FOR  CONTINUOUS  ,  A 
1  D~  FOR  DISCRETE  VALUEV 
READ (KIN, 12 )RSG 
12  FORRAT(Al) 

IF  (RSG.EO.'C')  THEN 


Cl ■ I'DELTIR 

CALL  SCALE (RTD. RT, IRHT. IRHT. Cl) 

ELSE 

CALL  EQUATE C RTD. RT, IRHT, IRHT) 

END  IF 

C  RTD  IS  THE  DISCRETE  TIfC  APPROX  OF  RT 
CIM.O 

CALL  IDNT( IRFT.URl.Cl) 

C  UR1-GTD  *  I 
END 

mi.*  ss*is»Ff£l*BawsS'ai-ss*8B*as rasKu.  t*  r*™ 

C  INRORE  DETAIL  IN  E.  LLOYD  S  RASTERS  THESIS, DBI.afit, 

rIaL  CCX(NDrR?NDfl1),CCY( NDIR. NDIR )tGCZ(NDIR, NDIR), 

1BCY( NDIR. NDIR  ),  BCZ(NDIR,NDIR),PHIi( NDIR, NDIR), 

1  PHIC ( NDIR.NDIR ), RTD (NDIR, NDIR ),GTD( NDIR, NDIR ). 

i°BJ!S5S:!515J;BKJ»S:SSffi5:S5!S!S:!S5!55: 

1  SuhSiKwiM 

1  UUUINDIR. NDIR). GCSTR(NDIR, NDIR),  RKFSS(NDIR.NDIR  ), 

1  uxu(ndir:ndir).uri<ndir.n6ir).ur|(nd  n.NDIR  , 

1  UR3 (NDIR, HD I R ).URR< NDIR, NDIR) ,URS( NDIR, NDIR  > 

PEAL  YDCNDIR3  ) 

INTEGER  1FLGC2 
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CHARACTERNSCt66 , MSCiri ,  HSC2X1 

COmOH  /MAlNl/NDlM.NDIMl.COMl 

COMMON  /MAIN2/C0M2 

COMMON/ INOU/KIN,  KOUT .  KPUNCH 

COMMON  /NAIN4/NDIN2.NDIM3 

COMMON/MAUNS/MSC 

COMMON  /RNTIN/RNTIME.DELTIM 

CONNDN/NAING/ICBT,ICBn,lCFA,lCGA,ICCM,ICCT.lCQA.IRFA.IRFH.IRFT, 

1  IRHT,  IROA,  10 ,  LOG,  1RHM,NUNDT$ 

WRITE (KOUT, I )  'ENTER  THE  TOTAL  RUN  TIKE  AMD  THE  SAMPLE  T1ME> ' 
READCKIN.X  (RNTIME.DELTIN 
11  FORftATC A1 ) 

C  CALCULATE  EQUIVALENT  DISCRETE  TIME  VERSIONS  OF.  BN-- BMD.GM — CMD-I, 

C  ON— OSD.  AMD  PHIH  THE  STATE  TRANSITION  MATRIX  FOR  FH 

C  SINCE  UORICSPACE  IS  AT  A  PREMIUM,  THE  TRUTH  MAODEL  MATRICES 
CPHIT.BTD,GTD,GTD,RTD  UILL  BE  USED  FOR  THEIR  CONTROLLER  MODEL 
C  COUNTER  PARTS  DURING  THIS  ROUTINE  BEFORE  THE  EQUIVALENT  DISCRETE 
C  TIME  TRUTH  MODEL  IS  COMPUTED.  AT  THAT  TIME  THERE  IS  NO  LONCEO  ANY 
C  NEED  FOR  THOSE  CONTROLLER  MODEL  MATRICE  SINCE  THE  CONTROLLER  IS  PUT 
C  INTO  THE  PERFOBANNCE  ANALYSIS  FORMAT, PKIC  »CY . GCZ 

cmmmxmtttmmtKmtmtumttnmtxtmtxmutnxtxttn 

NSAV3-NMM2 

NDIH2-NDIH 

CALL  NYINTG(PHIT , CTD, £TD,RTD,GM,ON,FM,BN, IRFM, ICON, I CBM, ICON ) 

C  RTD  IS  USED  AS  DUMMY  WORK  SPACE  IN  CALL  TO  MY INTO 
NDIM2-NSAV3 

CALL  IDNTCIRFM.CTD, X .000 ) 

WRITE(KOUT,x  J  'ENTER  A  C  IF  THE  VALUED  ENTERED  INTO  RFI  IS  A  CONTIN 
1U0US  TIME  VALUE  TO  FORM  THE  BASIS  OF  AN  APPROXIMATE  DISCRETE  TIME 
I  RM, ENTER  A  D  OTHERWISE)' 

READ (KIN, 11  )MSG1 
IF  CMSCl.EG.'C' J  THEN 
C  APPROXIMATE  RMD-RN/SAMPLE  TIME 
Cl-l/DELTIM 

CALL  SCALE  t RTD, RM, IRHM, IRHM.Cl ) 

ELSE 

C  THE  VALUE  IN  RM  IS  DISCRETE  TIME  ALREADY 
CALL  EOUATEIRTD.RM.IRHM.IRHM) 

END  IF 

C  SET  UP~X  ,  S  ,  AND  U  FOR  DDTCON 

CALL  XSUCGC2,CCY,PHIC,CCX,BCY,BCZ,R<FSS,U«1.VM2.UM3,U(M,UM5, 

1  FM.BM, IRFM. ICBH.UXX,UUU,UXU,PHIT ) 

C  GCZ  NOV  CONTAINS  X,  PHIC  CONTAINS  U.CCY  CONTAINS  S 
C  OCX. BCZ, BCY, RKFSS  WERE  DUMMY  WORK  AREAS  IN  XSU 

CALL  DDTCON ( PHI T , UXX . CCX . GCZ , BTD , PHIC .RKFSS. BCY . BCZ. GCV. UUU, 

1  GCSTR, WXU»UN1,UH2,WM3,UH4,UN5 ) 

CBCY.BCZ, GCV. PHIC. GCZ. OCX, RKFSS  ARE  USED  AS  DUMMY  UORtC  SPACE  IN  DDTCON 
WRITE (KOUT.X)' DO  YOU  UISH  TO  COMPUTE  THE  KALMaN  FILTER  GAIN  OR  PIC 
IK  IT  DIRECTLY  (AS  IN  MAYBECK  SECTION,  14. S (ENTER  A  C  TO  COMPUTE  E 
INTER  A  P  TO  PICK  IT  DIRECTLY) ' 

READ  (KIN.IDHSGZ 
IF  (MSGS. EG. 'C' (THEN 

CALL  DKFTRtPHIT.BTD, CTD, QTD, CCX, RTD, HM.GCY, GCZ, PHIC. RKFSS, BCY, BCZ, 
1FM,GM,0M,BM,UM1,WM2 ) 

CGCX, GCV , GCZ , BC2 , BCY  ARE  USED  AS  DUMMY  UORK  SPACE  IN  CALL  TO  DKFTR 

CALL  PKDIRCXCCX, PHIT, CCv, GCZ, HM.BTD, RKFSS, ICBM, IRFM, IRHM) 

C  OCX, GCV, GCZ  ARE,  DUMMY  WORKSPACES  IN  CALL  TO  PKDIRC 

CXXXXXMKXMINTHE  FOLLOWING  CALCULATIONS,  BCV.CCY.BCZ  ARE  DUMMY  UORKSP 
C*««K**KACES  UNTIL  THEIR  LAST  USE  WHEN  THEY  ARE  SET  EQUAL  TO  THEIR  F 
CXXXXXXZtINAL  VALUES  FOR  PERFAL  SUBROUTINE 
Cl«l.« 

CALL  IDNTt IRFN,BCY,Cl  I 

CALL  MAT1 (RKFSS, HM, IRFM, I RMM, IRFM, GCV ) 

CALLlMADDl ( IRFM, IRFM, BCY ,CCY,BCZ,Cl ) 

C  BCZ  •  I -RKFSS (HR ) 

WRITE (KOUT^X) 'DO  YOU  WISH  TO  CALCULATE  THE  SAMPLED-DATA  FILTER  P 
10LES’  Y  OR  N> ' 

READ(KXN,12 (MSG 

IF  (MSG.EQ. *V* )  THEN  _ 

WRITE?KOUt!*  rtHpElGENUAlUE^THA^CORRESPOND  TO  THE  SAMPLED-DATA 
1  FILTER  POLES  ARE . ' 
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THE  POLES  OF 
N> ' 


THE  OPTWAL 


POLES  OF  TH 


N 


CALL  NEIGN(PHIC,UUl,UU2.IRFN,un! ) 

END  IF 

CALL  SCALE<BCY,GCSTR, ICBN, IRFN, Cl > 

C  BCV- -CCSTR  *•  ICBN  X  IRFN 
IF  (H$C2.EQ.'C' >  THEN 

C  FORNULATE  THE  0°TINAL  CONTROL  LAU  FOR  PERFAL 
CALL  NATKBCY,  8C2,  ICBN,  IRFN,  IRfN.GCX  ) 

C  OCX*  -GCSTR( I-ftKFSS<HN ) )  ICBN  X  IFRN 
CALL  NATH BCV. RKFSS . ICBN, IRFN , IRHN.CC2 ) 

C  GC2-  -GCSTR(RKFSS)  ICBN  X  IRHN 
IFLCC2-0 

CALL  NAT 1(BTD, BCV, IRFN, ICBN,  IRFH, CCSTR ) 

Cl-l.B 

CALL  NADD1 ( IRFN, IRFN. PHIT, GCSTR , BCV, Cl ) 

C  BCV-  PHIT-BTD(GCTR)  IRFN  X  IRFN 

uriteocout.xi'  ' 

URITE(ICOUT,X)'DO  YOU  UISH  TO  CALCULATE 
1  LO  SANPLED-DATA  CONTROLLER?  Y  OR 
READOCIN,  12 )HS6 
IF  CNSG.EO.'Y')  THEN 

URITE(R«UT,*)‘THE  EIGENVALUES  THAT  CORRESPOND  TO  THE 

IE  OPT  INAL  LO  CONTROLLER  ARE . 

CALL  N£IGN<BCY,UV1.UV2, IRFN, PHIC) 

END  IF 

CALL  NAT1(BCV.BC2, IRFN. IRFN, IRFN, PHIC ) 

C  PHIC  • (PHIT- BTD( GCSTR  ) )  ( I-RKF5S(HN ) )  IRFN  X  IRFN 
CALL  NAT1 (BCY.RKFSS, IRFN.  IRFN,  IRHN.BC2  ) 

C  BC2-(PHIT-BTD(CCSTR))RKFSS  IRFN  X  IRHH 
ELSE 

C  FORNULATE  THE  SUBOPTINAL  CONTROL  LAU  USTR— CCSTR(X  AT  TSUB  I  NINUS) 
CALL  EQUATE (GCX.BCY. ICBN, IRFN) 

C  GCX— CCSTR  ICBN  X  IRFN 

CALL  NAT1 (PHIT.BCZ. IRFN, IRFN, IRFN, CCSTR ) 

Cl-l.B 

CALL  NAT1 (BTD.CCX, IRFN. ICBN, IRFN, BCV ) 

WRITE OCDUT, J ) '  ' 

WRITE  UCOUT.t  (■'DO  VOU  WISH  TO  CALCULATE  THE  POLES  OF  THE  OPTINA 
1L  LO  SANPLED  DATA  CONTROLLER?  Y  OR  N> ' 

READUCIN,  12  iHSG 
IF-CNSC.EQ. 'V' )  THEN 
CALL  NADD1 ( IRFN, IRFN, PH IT, BCV, PHIC, Cl ) 

WRITE UCOUT.t) 'THE  EIGENVALUES  THAT  CORRESPOND  TO  THE  POLES  OF  THE 

10PTINAL  LO  CONTROLLER  ARE . ' 

CALL  NEIGNf PHIC, UU1.UU2, IRFN, UNI J 
END  IF 

CALL  NADDKIRFN. IRFN, GCSTR. BCY, PHIC, Cl) 

C  PHIC-  PHIT ( I-RKFSS(HN ) )-8TD, CCSTR  IRFN  X  IRFN 
CALL  NAT 1 (PHIT , RKFSS, IRFN, IRFN, IRHN.BC2 ) 

C  BCZ*PHIT( RKFSS )  IRFN  X  IRHN 
DO  101  I -1 . IRFN 
DO  lBlJ-l.IRHN 
1B1  GC2C I, J )"0 
1FLCC2-1 
END  IF 
IRV-l 

DO  1*2  I-i.NDIN 
DO  1«2  J-l.IRV 
CCYU.J)-0 
l«e  BCV( I , J )*• 

do  ib?  i >1,1 tee 

IB?  VD( I  )-• 

IO-S 

NSG* 'PHIC  FOR  THE  SANPLED  DATA  CONTROLLER  IS' 

CALL  NNATIO(PHIC, IRFN, IRFN, IO,K IN,KOUT,NDIN,NDIN ) 

URITE(KOUT.x)'  ' 

URITE<rOUT,*)'DO  VOU  WANT  TC  CALCULATE  THE  EIGENVALUES  OF  THE  LOG 
1  CONTROLLER  STATE  TRANSITION  NATRIX,  PHIC?  V  OR  N> ' 

•READUCIN.  12  >NSC 
IF  (NSC. EC. 'V' )  THEN 

VRITE  t  KOUT ,  t ) ' THE  EIGENVALUES  OF  THE  LOG  CONTROLLER  STATE  TRANSITI 

ION  NATRIX  ARE . ' 

CALL  NEICN(PHIC,UV1,UW2,IRFN,WNI) 
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-v  - 


i 


end  ir 

nsG*  'bcz  follows.  bcy»b' 

CALL  HNATIOtBCZ.IRFM.IRHM.IO.KIN.KOUT.NDir.NDir,) 

MSG»'GCX  FOR  THE  SAMPLED  DATA  CONTROLLER  IS' 

CALL  MMATlOCGCX.ICBM.IRFn.IO.KlK.KOUT.NDIM.NDiri) 

IF  tnSGE.EG.'C' )  THEN 
MSG*'GCZ  FOR  A  COMPUTED  KFSS' 

ELSE 

MSG*'CCZ  FOR  KFSS  PICKED  DIRECTLY' 

CAU^MNATIOtCCZ.ICBH.IRHM.IO.KIN.KOUT.NDin.NDin) 

URITE(KOUT.x)'  GCY  IS  SET  •  «' 

C  THIS  IS  A  REGULATOR  SO  YD  IS  ALUAYS  ZERO 
NSAU3-ND1M2 

CALL^ MYINTG<PHIT,QTD, BTD.RTD.CT , QT.FT ,BT,  IRFT,  ICCT,  ICBT,  IRHT ) 

C  RTD  IS  USED  AS  DUMMY  UORK  SPACE  IN  CAL  TO  NYINTG 

C  PHIT^OTD^BTD^ARE  EGUIW.  DISCRETE  TIME  REPRESTATIONS  OF  TRUTH  MODL 
C  HATRICE 

URItI(KOUT'*)'  UAS  THE  VALUE  ENTERED  IN  RT  DURING  It&JT  A  CONT2NUO 
1US  TIME  OB  A  DISCRETE  TIME  VALUE?  ENTER  A  C  FOR  CONTINUOUS  ,  A 
1  D  FOR  DISCRETE  VALUED' 

READ<  KIN, 12  )MSG 
IE  FORMAT (A1 5 

IF  (M5G.EO. 'C' )  THEN 
Cl'l/DELTIN 

CALL  SCALECRTD.RT, IRHT, IRHT. Cl > 

CALL  EQUATE! RTD. RT, IRHT, IRHT) 

C  RTD  IS0 THE  DISCRETE  TIME  APPROX  OF  RT 

ci-i.e 

CALL  IDNTC IRFT,GTD.C1) 

C  GTD-GTD  •  I 
RETURN 
END 

XDECK  D<FTR 

SUBROUTINE  DKFTR(PHIM.BnD.CMD,QMD,UMl,RnD.HH.wn3,UM5.UM€,RICFSS, 

1  F2.H2.FH,Cr.0H.BH.UM2,UH«) 

C  “  THIS  ROUTINE  CALCULATE  THE  STEADY  STATE  KALMAN  FILTER  GAIN  MATRIX 

C  FOR  A  SAMPLED  ATA  CONTROLLER 

REAL  PHIHCHDIM.NDIN  J.BMDt NDIM.NDIM  ),OMD(NDIH,NDIM ), 

1  GMDCNDIH.NDIM  J.UM1  tNDIM.NDIM  ),RF!D(NDin,NDIM  ), 

1  HH(NDIM,NDlm,  UM3(NDIM,NDirU,  Uf!S(  NDIM.NDIM  ), 

1  UMS(NDIM.NDIM),  RKFSS !ND I M, NDIM  ),F2( NDIM.NDIM ) 

1  ,H2(HDIM,NDIM  >,FM( NDIM.NDIM ) , 

1  GM(NDIH,NDIM ),QM( NDIM.NDIM ),BM!NDIM,NDIM ), 

1  UM2(NDIH,NDIM ),UM4(NDIM,NDIM ) 


REAL  C0Ml<t),C0H2U> 

COMMON  /MAIN1/NDIM.NDIM1.COM1 

'ISS.'i'  kin.kout.kpunch 

COMMON  /RHTIM/  RNTIME.DELTIM 
COMMON/MA I N4/ND I ME , ND I  M3 
COMMON^MAUNS/MSG 
COMMON  /MAINE'  COM2 

CHARACTER  MSGISt.MSOtGB 

f JERJllNXSTXC  STATES  AS  IN  THE  CONTINUOUS  TIME  CASE 
1  THIS  RuH  YOU  MyWtO  MS  ?3|  52tul  S?\Sg$g  ISPftSrW 

‘REAflKlSilnHSCl8™”-  D°  Y°U  U™T  T°  CHANCE  V 

NUMSAW»NUMDTS 
IF  (MSOl.EO.'Y'}  THEN 

READfKINUI)i5wDTSER  ^  WAUi‘  *  hinCTS  F0S  ™IS  «UN>  ' 

END  IF  ' 

URITEOCOUT.X )  'NUHDTS*  '.NUMDTS 
IDS-NUMDTS^l 
IRFE.IRFM-NUMDTS 
IF < NUMDTS. EO.B )  THEN 
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2  .S,T$5E*5SIE5..!,2,,EL  IN  intermediate  matrices  compatible 
C  I  CAu1L*TE^2^?^2?Tlr^TERnlNISTIC  STftTES  REn0UED 

CALL  EGUATECUM1 ,GMD, IRF2, IRF2  J 
CALLlE0UATE<H2,HH,  IRHM,  IRF2 ) 

CALL  EQUATE ( UM5, BUD, IRF2, I CBM ) 

CALL  EOUATE(UM2,OMD.IRF2,IRF2) 

£  D|^TfLIHf  deterministic  STATES  form  the  model  used  to  form 

C  ™EJTIAP*  STATE  KALMAN  FILTER  CAIN  MATRIX 
DO  2112  I • IDS. IRFH 
II-I-NUMDTS 
DO  2112  J-IDS.IRFM 
JJ*J-NUMDTS 

2112  UM4(II,JJ)-FM(I,J) 

DO  2113  1*1. IRHM 
DO  2113  J-IDS.IRFN 
JJ» J-NUMDTS 

2113 

C  FORM  B2D  C2D  NOU 

DO  21  IS  I-IDS.IRFM 
II*1=HUNDTS- 
DO  2116  J*l, XCIM 
2115  UM3(II.J)»BM(I,J> 

DO  2114  i-ids.irfm 

II-I-NUMDTS 

DO  2114  J-l.ICGH 

2114  WH1(II,J)»CM(I.JJ 

11  FORMATfAl) 

NSAU-NDIM2 

NDIM2-NDIM 

CALL  H V I NTG ( F2 , UM2 , UMS , WHS , UM 1 , OH , UM4 , UM3 , X RF2 , I COM , I CBM , I COM ) 

NO I M2* NS AV 

ci-t.e 

CALL  IDNTCIRF2,UM1.C1) 

END  IF 

C  CALCULATE  CUD  (OHD1  CMDT 

CALL  MAT3( IRF2. XRF2.UH1 ,UN2. RKFSS ) 

CRKFSS  IS  DUMMY  WORK  SPACE  AT  THIS  POINT  IN  THE  PROCRAM 

-  WRITE (KOUT.I)'  DO  YOU  UISH  TO  MODIFY  THE  OMD  MATRIX  BY  THE  DOYLE 
-1  AND  STEIN  TECHNIQUE  FOR  CONTINUOUS  TIME  CONTROLLERS  EXTENDED  TO 
1  THE  DISCRETE  TIME  SYSTEMS.  Y  OR  N> ' 

READ(KIN, 1 1 )MSC1 
IF  (NSCl.EQ.'Y')  THEN 

CALL  DAS2 ( BM . RKFSS . WM t , ICBM , UM3 , IRF2.UMS ) 

C  RETURNS  A  MODIFIED  OMD  UALUE  TO  BE  USED  IN  FINDING  RKFSS 

C  CALCULATE  THE  KALMAN  FILTER  GAINS,  RKFSS,  FOR- EITHER  THE  MODIFIED 
C  OMD  OR  THE  UNMODIFIED  OMD 
C  OMD  IS  STORED  IN  RKFSS 

CALL  TRANS2< IRHH, IRF2.H2.UH3 > 

CALL  KFLTR(IRF2,IRHM,F2,Ur.3, RKFSS, RMD.UM6.UM1.UM5) 

C  UM6*PMSS.UM5  CLOSED  LOOP  NEAS  MATRIX 

C  UMl  «  RKFSS  WITHOUT  THE  ZEROS  FOR  THE  DETERMINISTIC  STATES 
C  NOU  ADD  THE  ZEROS  FOR  THOSE  STATES 
IF  (NUNDTS.EQ.e? THEN 
DO  2029  X-l.IRFH 
DO  2029J-1.IRHH 
2029  RKFSSC I , J  )»UM1 < I, J ) 

ELSE 

DO  2119  J*1,IRHM 
DO  21181- l.N'JMDTS 

2118  RKFSSt I, J )-0 

DO  2119  I • IDS, IRFM 
II-I-NUMDTS 

2119  RKFSS (I.J)-WMl(Il.J) 

END  IF 

C  NOU  WRITE  OUT  THE  RKFSS  MATRIX 
2?  10-5 

M SO- 'STEADY  STATE  SAMPLED  DATA  KALMAN  FILTER  GAIN  MATRIX' 

CALL  MMATIOC RKFSS. IRFM, IRHH, IO.KIN,KOUT,NDIM,NDIM) 

NUNDTS-NUMSAU 

RETURN 

END 

FDECK  DAS2 

SUBROUTINE  DAS2<BM,QMD,U,  ICBM.WM3,  IRF*’.  yMl ) 

REAL  BM<NDIM,NDIM).Q«D<NDIM,NDIMJ,  UCNDIH.NDIH ). 
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i  u«3<ND:n,N2ir ),  yfti(NDir,,NDin) 

C  this  ROUTINE  ALLOUS  OMD  TO  EE  MODIFIED  IN  A  RANKER  SIMILAR  TO  THE  DO 
C  VUE  AND  STEIN  TECHNIQUE  FOR  CONTINUOUS  TIKE  SYSTEKS. 

C  0”r*NOD«OKD  ♦  (SOXSO)tBnCV>BMT)XSAr.PLE  TINE 

C  WHERE  SO  IS  A  SCALAR  DESIGN  PARPMETER  AND  V  IS  A  POSITIUE  DEFINITE 

C  SVflNETRICtNATRIX  DESIGN  PARAMETER .  AS  SO - >TO  INFINITY  IN  THE  CO 

C  NT1NUOUS  TINE  CASE/  ROBUSTNESS  PROPERTIES  OF  A  FULL  STATE  FEEDBACK 
C  CONTROLLER  ARE  RECOVERED.  THIS  ROUTINE  IS  BASED  ON  E.  LLOYDS  PIASTERS 
C  THESIS  , DEI ,  AFIT 

character  nsctse 

REAL  COM1C1  ), COP2(l) 

COMMON  /MAlNl/NDIM.NDINi.COMl 
COMMON  /fiNTIR/RNTIHE.DELTIM 
COMMON  /MA'JNS/MSG 
COMMON  /RAINS/  COre 
COMMON  /INOU/KIN.KOUT.KPUNCH 
URITECKOUT.il>*  * 

11  FORNATCAl) 

WRITE  t ROUT, X )  'THIS  ROUTINE  MODIFIES  THE  VALUE  OF  OND  USED  TO  CALCU 
1LATE  THE  STEADY  STATE  KALMAN  FILTER  GAIN.  THE  RODIFICATION  RERFOR 
1MED  IS  SIRILAR  TO  THE  DOVLE  AND  STEIN  TECHNIGUE  FOR  CONTINUOUS-TIR 
IE  SYSTERS.  FOR  A  COMPLETE  DESCRIPTION  SEE  E.  LLOYDS  RASTERS  THESI 
}s»  RPjLJ/.PSK  BRIEFLY  THE  RODIFICATION  ATTEMPTS  TO  ENHANCE  ROBUST 
1NESS  OF  The  LOG  CONTROLLER  AND  IS  ONOD^CPID (OND )CNDT*S01S0XDELTlr, 

U’iKIIte*  ll&$??c5KiiVES£??  JSA'SK.'VU 

'I  SlE°IJKS1.dI£pu?ITT,x'  ch“m,"c  «“  »seUoo»oISE  «» 

•  URITECKOUT.il)'  ' 

URITECKOUT.X ) 'ENTER  1—  TO  INPUT  SO,  S—  TO  INPUT  V,  3—  TO 

1  CONFUTE  MODIFIED  0,  4~  TO  EXIT  ROUTINE . NOTE  I  .8  RUST  BE 

l  ACCORPLISHED  BEFORE  3.  AND  3  BEFORE  4,  BUT  THAT  IB  3,  CAN  BE 
1  DONE  ANY  NUMBER  OF  TINES  BEFORE  USING  4' 

S  URITECKOUT.il )'  ' 

URITECKOUT, X  5 'ENTER  OPTION>' 

READ c KIN. X)IOPT 
GO  TO  (  1.2.3.4U0PT 
1  URITECKOUT.il)'  ' 

URITECKOUT.X ) 'ENTER  S0>' 

READCKIN.X )SQ 
tO  TO  S 

£  URITECKOUT.il)'  ' 

tWITE C KOUT , x ) ' U  IS  INITIALIZED  TO  THE  IDENTITY  MATRIX  UPON  ENTRY  T 
10  THIS  OFT I ON.  IF  YOU  DESIRE  TO  CHANCE  U  ...REMEMBER  IT  MUST  BE 

1  POSITIUE  DEFINITE . ENTER  THE  I/O  OPTION  CI/O  OPTIONS  ARE 

1  PRINTED  AT  THE  BEGINNING  OF  THE  PROGRAM)  ELSE  ENTER  M  >' 

ci-i.e 

CALL  IDNTC ICBfl.V.Cl ) 

READCKIN.X ) 10 
IF  CIO.EO.e)  THEN 
GO  TO  S 
ELSE 

RSG* 'THE  CHOSEN  V  MATRIX  IS' 

CALL  RRATIOCU, ICBM, ICBR, IO.KIN.KOUT.NDIR.NDIR ) 

END  IF 
CO  TO  S 

3  URITECK0UT.il)'  ' 

CALL  RAT4CU.BR, ICBM, ICBM, IRFR, UM3 ) 

CALL  MATl CBM. UM3.IRFM. ICBR, IRFR.UMl ) 

Cl*SQ*SOXDELTIR 

CALL  RADClClRFR,IRFn,0MD,UMl,Ur.3,Cl ) 

lo-s 

use* 'modified  o  ratrix.  qmod*' 

CALL  MMATIOC U"3, IR"M, IRFM, lO.KIN.KOUT.NDIM.NCIR ) 

CO  TO  6 

4  CALL  EQUATE C0nD.UR3.IRFR. IRFM) 

C  REPLACE  THE  VALUE  IN  OMD  UITH  0M0D 

RETURN 

END 

XDECK  |5TC0Ntihe.  j3pTC0NC FHIR, UXX, URt  ,X, BMD.U.UM2 .PHIPRM , 

1real 1 coni d ^ ' coni c  n ,  phir  c  nd in , nd in  > , 
iwxx  cNDin,NDin),wMi(NDin,NDin),xcNDin,N&in>, 

1  BnDCNDin. NDin ) ,  U(NDIR,NDIM),UR2CNDIM,NDIR>, 

»  PHIPRMCNDIH.NDin ),XPRinCNDIR.NDin),SCNDIR,NCin), 

1  WUJ 'NDin.NDIP ) .CCSTRCNDIn. NDIM  > 


■ 
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character  mscxcb 

common  /maini/ndim.ndimi.comi 

COMMON  /MAIN2/  com 
COMMON  ✓HAIN4/NDIH2.NDIM3 
COMMON  '1NCU/KIN,K0UT,KPUNCH 

common  /RNTin/  rntime.deltim 

lC?5ilT?iRo2!  10  AOc!lRH*?HUM?S1CCA'  ICM‘ ICCT* ICM* IRF*' 1RP"« IRFT' 

COMMON  /MAUN5/NSG 

SUBROUTINE  COMPUTES  THE  STESDY  STATE  OPTIMAL  FEEDBACK  CaIh  ha'pi 

c  da?a1cntKr0N  *  L1N£Aft  cu*DBflTlc  C°ST  criterioS!EfopCa  §2M'R1 

C  SEE  MAYBECK  CHAP  14  FOR  A  DETAILED  DISCUSSION  OF  ALGORITHM  AND 
C  EQUATIONS 

CXXXXXXXXXXXXXXXXXZXXZXXXXXXXZSXXXXXXXXXXXXXXXXXXXtXXXXXXXXXXtXXXXrxXXXX 

HT-1 


TRANSFORM  SYSTEM  SO  KLE INMAN  R1CCATI  SOLUER  WILL  HANDLE  S  NOT-O 
CALL  PRIHIT(WM2.U, ICBM, CCSTR, S. IRFM, BMD.WMi.PHIPRM.X.XPRIM, 

1  PHIM) 

UM2-UIXST 

ChOU  COMPUTE  KPRIM  FROM  RICCATI  EQUATION 
CALL  MMT3< IRFM, IC»M, BMD. CCSTR. UM1 ) 

CALL  DRICC IRFN.PHIPRM.WMl .XPRIM.X, CCSTR ) 

C  CCSTR  CONTAINS  INFO  THAT  IS  NOT  USED 
C  X  CONTAINS  XXKPRIMXX  IRFfl  X  IRFM 
C  NOW  COMPUTE  CCSTRPRIN 

cw.e 

CALL  NAT3( ICBM, IRFM, BMD, X, CCSTR  ) 

CALL  MADD1 ( I  CBM. I CBM, U , CCSTR ,WM1 ,C1) 

•  CALL  CMINUCICBM, ICBM, UM1, CCSTR, MR, NT) 

IF  (MR.NE.ICBM)  THEN 

PRINT  X,  '  1NUERSE  OF  U  IN  DDTCON  NOT  OF  FULL  RANK.  RANK  IS  '-, 

1  MR,'  RANK  SHOULD  BE  'ICBM-', ICBM 
END  IF 

CALL  MAT4(CCSTR,BMD,1CBM,ICBM,IRFM,UM1) 

CALL  MAT1 (UNI ,X, ICBM, IRFM, IRFM. CCSTR > 

CALL  MAT1 (CCSTR, PHIPRM, ICBM, IRFM, IRFM, UM1 ) 

C  UM  1  -  GCSTRPR I  (1  •  (  (  U+BHDT  ( KPRI K  >BND  )  I  >  f  BPJ>  I KPRIM  )PHI  PRM ) 

C  ICBM  X  IRFM 

CALL  M ADD 1 ( I CBM . I RF M . UM I , UR2 , CCSTR , C 1 > 

C  CCSTR  ICBM,  X  ICBM 

10  -S 

MSG- 'THE  OPTIMAL  STEADY  STATE  FEEDBACK  CAIN  MATRIX, CCSTR' 

CALL  MHATIO ( CCSTR ,  ICBM ,  IRFM, ,  1 0 , KIN , KOUT , NDIM .  ND IM ) 

RETURN 

END 

XD^OK  PtCDIRC 

SUBROUTINE  PKDIRC(U,PHIM,UM1  ,UM2,HM, BMD, RKFSS, "ICBM, IRFM, IRHM ) 

REAL  C0Ml(l),C0N2U).U(NDir,,NDIM), 

1  PHIM  (NDIM, NDIM ) ,  UMl (NDIM, NDIM) ,  UM2<  NDIM, NDIM ), 

I  HM(NDIM,NDIM),  BMD(NDIM,NDIM),  RKFSS( NDIM, NDIM) 

CHARACTER  MSG>6B.MSCm 
COMMON  /MAINI/NDIM.NDIMI.COMI 
COMMON  ✓MAIN2/C0M2 
COMMON  /MAUN5/  MSG 
COMMON  /INOU/  KIN,  KOUT.KPVJNCH 

C  AS  IN  MAYBECK,  SECTION  14. S.  RKFSS-PHIMKBMD  >W  XSQ.  SO  IS  A 
C  SCALAR  DESICN  PARAMETER  AND  U  IS  ANY  NONSIHGULAR  M  X  H  MATRIX. 

C  MAYBECK  SUGGESTS  THAT  U- (MM(PHIHI  )BMD  )I  IS  A  POSSIBLE  CHOICE. 

C  THE  RKFSS  PICKED  AS  A  RESULT  OF  THIS  ALGORITHM  FORMS  THE  BASIS 
C  OF  A  SUBOPTIMAL  CONTRL  LAU,USTAR-OCSTR(X( TI-MINUS ) 

URITEIKOUT , 12  )  '  1 

URITE(KOUT, X  ) 'THIS  ROUTINE  CALCULATES  THE  STEADY  STATE  KALMan  FILT 
1ER  OAIN  DIRECTLY(  THAT  IS  WITH  OUT  USE  PMSS  FROM  THE  MATRIX  RICCA7 

11  EOUATION  AS  THE  BASIS  OF  KFSSJI  EOUATION  AS  IN  SECTION  14. S  , MAY 
1EECK.  KFSS-SQx (PHIMI  ) B rtD ( U  )  UKERE  THE  SCALAR  SO  AND  THE  MATRIX 

l  U  ARE  DESICN  PARAMETERS... THE  LARGER  THE  SO  THE  MORE  ROBUSTNESS 
1  THE  SUBSEQUENT  CONTROLLER  UILL  HAUE.  NOTE  THERE  ARE  NO  STAEILIT 

•  IV  CLAIMS  FOR  THE  RESULTING  CONTROLLER,  SO  BE  SURE  TO  CHECK  THE  El 
1GENUAIUES  Or  THE  SUBSEQUENT  CONTROLLER.' 

WRITE (KOUT, IS > '  ' 

12  FORMAT! Al/ >  _  „ 

URITE(KOUT,X)'THE  OPTIONS  FOR  THIS  ROUTINE  ARE  1->CMO0SE  SO,  e->  C 

1 MOOSE  U,  3-.  COMPUTE  AND  PRINT  RKFSS,  4->  EXIT  ROUTINE . ' 

S  WRITE (KOUT , 12 ) '  ' 
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WRITE ( KO'JT ,  t ) ' ENTER  OPTION)' 

READtKIN.X  3I0PT 
GO  TO  U.2,3,43IOPT 
CC  TO  4 

1  yRITlllCOUT.'^'EHTER  A  VALUE  FOR  SO.  LARGER  SO  GIVE  BETTER  ROBUSTKE 
1SS)' 

READ<KIN,X)SQ 
GO  TO  5 

C  dttTEOCO’JT?x*M)0  VOU  WANT  TO  PICK  U  ARBTRARIIV  OR  DO  VOU  UANTU  TO 
1  BE  HN<PH1MI>8MD  -'INVERSE  AS  IN  NAVBECK  SECTION  1J.S.  NOTE  TH" 
l  IRHfTmJST  BE  EQUAL  TO  ICBM  SINCE  U  MUST  BE  ICBM  X  .CBN.  ENTER 
IAN  A  FOR  ARBITRARY,  U  OTHERWISE)' 

REAtKKIN.il  >MSG1 
H  FORMAT (Al) 

WmtKOUT^T'ENTlR  I/O  OPTION  FOR  UlSEE  INPUT  ROUTINE  FOR  EXPLANA 
1TION  OF  INPUT  OPTIONS  1,2.3,4.5,63)' 

READtKIN.X  310 

clLL'wlTIO^ICBIVlCBn.IO.KIN.KOUT.NDin.NDIN) 

ELSE 

C  COMPUTE  U  AS  DESCRIBED  ABOVE 

UPITE?KOUTfiI)l'NOTETTHAT  IRHM  MUST  EOUAL  ICBM  TO  USE  THIS  METHOD  OF 
1  CALCULATING  W,  ICBM- ICBM, *  IRHM-  '  , IRNM 
CO  TO  S 
END  IF 

CALL  EOUATE t  UNI »PHIM, IRFM, IRFM  > 

C  CMINV  DESTROVS  THE  CALLING  ARRAY 
MT»i 

CALL  GMINUt IRFM, IRFM, WM1 ,UMa,MR,MT  3 
CALL  MAT1CHK, UM2. IRHM, IRFM, IRFM.UHl) 

CALL  MATltUMl, BMD, IRHM, IRFM, ICBM, WM23 
CALL  CHINVt IRHM, ZCBN.UN2, W.NR.HT  3 
END  IF 
CO  TO  5 

3  WRITE (KOUT, 123'  * 

C  CALCULATE  RKFSS 

CALL  EQUATE (UMl.PHIM, IRFM, IRFM) 

C  CMINU  DESTROYS  CALLING  ARRAY 

CALL  GMINU<  IRFM,  IRFM.UN1 ,WH2.MR.NT ) 

CALL  MAT H  UM2, BMD , IRFM , IRFM , ICBM , W«1 3 

CALL  MATKUni.W. IRFM, ICBM, ICBM, WM2) 

CALL  SCAL£<RKFSS,UM2, IRFM, IRHM, 50 3 
10-5 

MSG* 'RKFSS,  PICKED  DIRECTLY  IS' 

CALL  MMATIO(RKFSS, IRFM, IRHM, 10, KIN, KOUT.NDIM.NDIM) 

GO  TO  5 
A  RETURN 
END 

XDECK  lyJ^OUTINE  PRIMIT<WH2, U, ICBM, GCSTR.S, IRFM, BMD, UMl.PHIPRM.X.XPRIH, 
t  PHIM) 

C  THIS  SUBROUTINE  COMPUTES  THE  PRIMED  CUANTITJES  NEEDED  WHEN  USING 
C  KIEINMAN  RICCATI  SOLVER  WITH  NON  ZERO  CROSS  COST  WEIGHTING 
C  MATRIX  UXU 

REAL  WM2<NDIM,NDIM3,CCSTR1NDIM,NDIM3,S CNDIM.NDIM), 
lBMDtHDIM.NDIH  ),WH1 tNDIM,NDIH),PHIPRNlNDIN,NDIM), 
l  XtNDIM,NDIM),XPRIM(NS:M,NDIM),PHIMtNDIM,NDIM> 

real  conitn.coNem 

COMMON  /MAIN!/  NDIM.NDIMl.COMl 
COMMON  /MAIN2/C0M2 
COMMON  /INOU/KIN,KOUT,KPUNCN 
C  NOW  COMPUTE  XPRIM,  , 

CALL  EOUATE <WN2,U, I CBM, ICBM) 

C  GMINV  DESTRIYS  THE  CALLING  ARRAY 

CALL  CMINUt ICBM, ICBM,UM2.CCSTR,MR,MT  > 

C  CCSCALtUMAT4<CCSTR,S? ICBM. ICBM, IRFM.WM2 ) 

CU"8’  CAUTM«Tl(BMD.WM2,iRFM.ICBM,IRFM,UMl ) 

CALL^ADDKIRFM,  IRFM, PHIM. UM1.PNIPRM, Cl  3 
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'•''-WWW  «  — «. , 


XRFTI  X'  JRFN 
.ICBN.IRFn.uni > 

.x, uni, xPRin.cn 

X  IRFN 


return 

END 
XDECK  RGS 

SUBRCOTmE  RCSt CCSTR,  RKFSS ,  CCX,  CCY , CC2 .  BCy  BC2  FC  VD 

}  *Ur.9,  UU2*  # 

i  un a . une . une , und , une . uhf . ft , bt , ct , ht , ot , rt,  •  *  * 

J-?1,lrl*C'1'H!,,'0!1'Rn'X0'P0*uxx>uuU*U>tU,FA,BP,Gft.QP,GUP. 

lNXA.PXA.RA.PXUA.GCZA.IRY.IFLCCZ.IFLCSD. 

,1^/£H5ft2i^niNiPX‘mA*  •  p*tnin .  nunAx ,  nun  in.  nx anax.  nxahin. 
i  PuouT.PxT0UT,nxTtxrr.nuour,uu3,uu4) 
real  conitn.conEd) 

5irsEKss?s?riS!r  *  * 

e  SJISikESu{loSMT?E;?lL!,w“  "**" 


CHARACTER  NSCX6*  . 

REAL  FT  (NDIN, NOW), ITtNDin.NDXni.CTtNDin, NDin). 

1  HT  tNfcin.NDIfU.Rn  (NDIH.NDW)  .FntNDXn.NDW), 
unworn,  NDin),Gn  tNDin,NDin),xocNDin>, 
lHntNDin.NDim.on  (NDxn,NDW>,potNDin,NDW>, 
iOT(NDin.NDin).RT  (ndxb.ndw), 

lGCSTRtNDIN.NDIH  ) . RKFSS(NDIN,NDin ), 
iuuHNDin),uuatNDin)#uxutNDin,NDin), 
iwni  worn, ndib  >.wn2  <HDin,NDin),un3tNDin,NDin), 
iuR4  tNDin.NDini.uns  tNDin.NDin ),unG(NDin, NDin ), 
tun?  (NDin.NDint.uns  (ndw.ndin ),uns  (hdw, ndin  ), 
lunie  <NDin.NDin>,unA(NDin2,ND!ns).unB(NDxn2,NDin2>, 
iunc(NDin2,NDin2>,unD(NDin2,ND:ne>,unE(NDxnz,NDin2), 
iunF<NDiN2,N0in2).uuu(NDin,NDin).uxxtNDin,NDiB),' 
lFA(NDW2,NDXn2  ),BA(NDIH2,NDin2).GA(NDin2,NDln2), 
inxA(NDtn2) .GCxtNDin.NDin ),GCZ(NDxn,NDin ), 
10A(NDin2,NDin2 ) ,PXA(NDIN2,NDln2 ),PXUA(NDIH2,NDIB2 ), 
WUOUTCNDW ) , BXTOUT (NOW > .PXTOUT (NDIN ) 

REAL  PU0UT(NDXn),VD(NDIN3),CUA(NDXH2.NDXn2>, 
lnxAnm  tHDin  ),nxAHAXtNDXn  )  .nuniNtNDW  >, 
inusAxt NDin J.PXTnxNt NDin j.pxrnpxt NDin). 
lPiiniNtNDin  i.PunAxtNDin  ),GCZA(NDins,NDin2), 
lRA(NDin2,NDin2 ) ,BCY  (NDIN, NDIN) .BCZt NDIN, NDin ), 
lUU3(NDin2),UU4(NDin2). 

1GCY  (NDin. NDIN). FC  (NDW.NDIU) 

INTEGER  IFLGCZ.IRY 
REAL  nutNDin ) 

connoN  /rntih/  rntwe.deltw 

COtWON  /NAJN2/C0f2 

connoN  /nAXNi/NDin, NDim.com 
connoN  /  inou/  kin.kout.icpunch 
COtWON  /nAIN4/NDW2,NDIR3 
connoN  /nauns/  nsc 


COWIOH  /RAINS/  ICBT , I CBN, 1CPA, I CCA, ICON, 1CCT. XC9A. 1RFA, IRFN.IRFT , 
t  IRHT . IROA.10.LOG, IRHN.NUBDTS 

URlTE(KOUT,*> 'ENTER  A  C  FOR  CONTINUOUS  TINE  LOG  CONTROLLER  AND  A 
1  D  FOR  A  SANPLED  DATA  LOG  CONTROLLER) * 

READ! KIN, 12, END-2833 )NSC 
IF  (NSG.EQ.'C')  THEN 
IFLGSD-O 

CALL  CLOCRS ( GCSTR . FN , BN . RKFSS . MN , GCX , GCY , GCZ . BC Y , BCZ , FC , VD , 
l  RN,GN,FT,BT,GT,GT,RT,HT, 

1 IRY . I FLCC2 . Wn 1 . WN2 , U«3 


i  , po, cn, un4 , uns , une . uu i , uuz . uuu , uxx , xo , uxu ,  un7 ,  une  > 

IF  (XO.EO.OITHEN 
CO  TO  2833 
END  IF 

CALL  FRNAUGCGT.RT.FT, BT , GCZ.HT .CCX.BCZ, FC.CCY.BCY.CT.XO.PO.FA.BA, 
i  GA,0A,GUA,uni.un2.unA,unB,unc,unD,unE,unF. 

1  BX A , PXA , RA » PXU A , GCZ A , I R Y , IFLGCZ, IFLGSC  ) 

WRITEOCOUT,*)'  ' 

WRITEtKOUT.t )  'DO  YOU  UISH  TO  CALCULATE  THE  EIGENVALUES  OF  THE  CLOS 
1ED-LOOP  F  BATRIX?  Y  OR  N>' 

READ (KIN, 12 >MSG 
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IF  (MSC.EO.'Y'  )  THEN 
NSAV1*NDIM 

ndin-ndimz 

NDIH1*NDIM2>H 

WRITE (KOUT,*) 'THE  EIGENVALUES  of  THE  CLOSED-LOOP  F  MATRIX  ARE...' 
CALL  M£ICN(FA,UU3,UU4, IRFA, UNA ) 

NDIM-NSAU1 

ndimi*ndih*i 

END  IF 

CALL  MYINTC(UNA,UM8,WNC,uriE,CA,0A,FA,BA,  IRFA,  ICGA,  IRY, IRQA) 

ELSE 

SOME  SAMPLED  DATA  CONTROLLER  IS  WANTED  ' 

URITE(KOUT,X)'DO  YOU  WISH  TO  MERELY  DISCRETI2E  THE  CONTINUOUS  TIME 
1  CONTROLLER,  Y  OR  N>' 

READ l KIN, 12, END *2933  >HSG 

URITC?k6ut|*')'XX*X***XNOTE  THAT  WHEN  ENTERING  THE  TIME  INCREMENT 
1  IN  THE  CONTINUOUS  TIME  CONTROLLER  SET  UP,  REMEMBER  IT  WILL  BECO 
1HE  THE  SAMPLE  TIME  FOR  THE  DISCRETIZED  CONTROLLER*********' 

CALL  CL OCRS ICCSTR . FM , BM , RKFSS , HM , OCX , GC Y . GCZ . Y, BCZ ,FC . YD. 

1  RM. ON , FT, BT , CT . QT.RT , HT , IRY, IFLCCZ.UM1 .UM2.UM3.PO .CM. _ 

i'~  UN4 ,  urts,  ums  .  wui  » uua,  UUU.UXX#  XO, UXU,  UM7, UM8  ) 

IF  ( IO.EO.Q )TH£N 
CO  TO  2933 
END  IF 

CALL  DSCRTZ(UHl,UM£,wr,3,UN4.!RFn,DELTlM,FC,ICY,IRY.»CZ,IRHN. 

I  WNS, WN6.CCSTR, GT, GT, FT, B T, IRFT ,JCGT,ICtT,IRHT, RKFSS.RT , GCX, 

1  ICBM ) 

WRITE (KOUT,*  ) '  ' 

WRITE (KOUT,* )  'DO  YOU  WANT  TO  CALCULATE  THE  EICENWALUES  OF  THE  STAT 
IE  TRANSITION  MATRIX  FOR  THE  DISCRETIZED  CONTROLLER?  Y  OR  N>' 
READ (KIN# 12  >H$G 

WITE?K6uT.‘*rTH£H|lGENUALUES  OF  THE  STATE  TRANSITION  MATRIX  FOR  T 
1HE  DISCRETIZED  CONTROLLER  ARE. ., ,' 

CALL  HEIGN(WME.UU1.UU2.IRFM,BCY) 

C  RKFSS0  IN  PRECEDING  CALL  STATEMENT  ARE  MERELY  DUMMY  WORK  SPACES 

1  PO ^ A , B A#  CA, QA , GUA , 8CY , FC , UNA,  UM8 , UMC , WND , WME , WMF , MXA.rXA, HA, 

1  PXUA.GCZA, IRY, IFLCCZ. IFLCSD ) 

ELSE 

C  ALLC  DLOGRS  (GCX.GCY.GCZ.BCY.ICZ,  UM3 .  FC ,  Jj^jUMS.WMl ,  UN4 .  FTl ,  BM . 

1  On.Cn.RM.HM,CT.QT,FT,BT.RT.HT,UXX,UUU,GwSTR,RKFSS,YD, 
l  IRY, IFLCCZ. WXU.WM6.UM7,WM8,UM9,UMie,WUi.UV2)  .  c  yfi 

CALL  FRMAUG ( UM 1 , WM2 ,UM3,WM4,GCZ,HT ,CCX,BC2,FC , CCY,BCV,UN5,X0, 

1  PO.FA,BA,CA.OA,CUA,RKFSS,GCSTR,UMA,WNB,WMC,WMD,UME,unF ,MXA,PXA, 

I  RA. PXUA.GCZA. IRY. IFLCCZ, IFLCSD)  ' 

C  RKFSS.GCSTR  ARE  DUMMY  UORK  SPACE  IN  CALL  TO  FRNAU- 
END  IF 
NSAU1*NDIM 

NSAU2-NDIM1  .  _  . 

NDIM1«NDIM2*1 

NDIM-NDIM2 

CALL  EQUATE (UMA, FA. IRFA, IRFA) 

CALL  EOUATE(WMC.BA,IRFA.IRY> 

CALL  MAT1 (CA.OA. IRFA. IRQA, IRQA.WME ) 

CALL  MATA  C UME , OA . IRFA , 1ROA , IRFA, WMB ) 

ndim-nsaui 

C  NOTEDFClAND*BCY  IN  CALL  TO  FRMAUG  ARE  DUMMY  WORKSPACES 
EMD  IF 
RETURN 
2533  IO»B 
12  FORMAT< A1 ) 

END 

XKCt  SUBROUTINE  XSU<X,Sty.PHIJO,BJO.PMlI.INTPXI,PMIJABJ, 

1  TE^.TEMPl,TEMPS,^.BM.I^M,lfcBM,WXX.WUJ.WX^  |N  THE 

i  2SuRa»™  sk;s;id;ErETS:w5^.E«EoSSi»L"jri..*>Ett. 
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C  THAT  is  CHOSEN  BV  THE  USER 

REAL  X  CNDIH.NDIH),  S<NDin,NDiri ) ,  U<NDIN.NDIM 5. 
lPHIJ0(NDIH.NDIN),8J0(NDI«,NDIH),PHn<HDIN,NDIR), 

1INTPII  (NDIM.NDIN  )  ,PHIJ(NDIN,NDIM  >,8J<NDIR,ND1N ), 

1TEMP  (NDIM.NDIN  ), TEMPI (NDIM.NDIN >,T£HP2  l  NDIM.NDIN), 
lFMCNDIN.NDIH  >,BN  (NDIM.NDIM  I.WXXCNDIN.NDIM ) , 

1UUU  (NDIM.NDIN  >.UXU<NDl«,NDin>,PHI?tNDlN.NDir,) 

REAL  C0N1(1).C0M2(1> 

CHARACTER  MSCX60 
COMMON  /NAlNlsNDin.NDIM.CONl 
C0MN0N/MAIN2/C0N2 
COMMON  /INCU/  KlN.KOUT.KPUNCH 
COMMON  /RHTIP'  RNTIME.DELTIN 
CONDON  /HAUNS/  MSG 
1ZIT-0 

DO  782  IJK-1.1O0O 

C  GIUE  USER  UP  TO  1008  CHANCES  TO  CHOOSE  DIFFERENT  SUBINTERUAL  LENGTH 


IF  UZIT.EO.liTHEN 
WRITE (KOUT  12)'  4 

WRITE OCOUt!*  ) 'DO  YOU  WISH  TO  RECONPUTE  X.S.U,  BASED  ON  A  DIFFERENT 
1  SUBINTERUAL  LENGTH,  Y  OR  N> ' 


READUClN.il  (NSG 
It  FORMAT (At) 

12  FORHATTAl./J ~ 

IF  (NSG.EQ. 'N' >THEN 

RETURN 

END  IF 

END  IF 

IZIT*1 

WRITE (KOUT.x) 'ENTER  THE  NUNBER  OF  SUEINTERUALS  TO  USE  IN  THE  A»eF 
IXINATIONS  OF  INTEGRALS  NEEDED  TO  CALCULATE  X,  S,  AND  U  tSUGCEST 
l  OR  MORE  »' 

.  READ(KIN.*)INTUAL 

C  NOW  INITIALIZE  UARIABLES  REQUIRED  IN  CALCULATIONS' 

Cl. 1.0 

CALL  IDNTURFN.PHIJO.Cl) 

Cl a0«  0 

CALL  IDNT( IRFN.X.Cl ) 

CALL  IDNT( ICBM.U.C1 ) 

DO  13  I-l.IRFN 
J)0  13  J-l.ICBN 
BJoa,J)-e 

13  "SII.JHB 


C  INITIALIZATION  COMPLETE,  NOW  CONFUTE  PHIJ.  1NTPHJ  FOR  SUBINTERUAL 
C  PHI , INTPHI  ARE  APPROXIMATED  BY  TAKING  AUERAGE  OF  UALUES  AT  THE 
C  BEGINNING  .END  AND  2  POINTS  IN  THE  RIDDLE  OF  EACH  SUBINTERUAL 
C  THIS  MEANS  S  SUB  SUB  INTERVAL  POINTS  TO  BE  CALCULATED.  HOUEUER,  0 
C  NLV  1  CALL  TO  INTEGRATE  ROUTINIS  REQUIRED  SINCE  FM  IS  A  CONSTANT 
C  MATRIX 

DEL-0. 0 

SUBINT*DELTIM'<  4XINTUAL  > 

DO  23  JK-1,  INTVJAL 

C  COMPUTE  PHIJ  BJ  AND  THEN  UPDATE  PHIJO.BJO 
C  FOR  EACH  SUBINTERUAL 
Cl- 1.0 

DO  371  INTUL-1.4 
DEL-DEL+SUBINT 


CALL  JJAT1  (INTPI I . BM,  IRFM,  IRFM, ICBM, TEH°i  ) 

CALL  HADDinRFN.ICBN.EJO, TEMPI, TEM», Cl  > 

.  *,nC$L.k  ECUA TE<E JO, TEMP, IRFM.  ICEM) 

C  BJO-BJO+INTPI HBM 
371  CONTINUE 
C  NOW  CALCULATE  BJ  PHI J 
Cl-0.2 

CALL  SCALEIPHIJ.PHIJ0,IRFR,IRFM,C1 ) 

CALL  SCALE(BJ,6J0.IRFR,ICBM,C1 ) 

C  BJ,  PHIJ  NOU  AVAILABLE  FOR  THIS  SUB  INTERVAL 
C  RESET  PHIJO.BJO 

CALL  EQUATE (PHI JO, PHI I, IRFM, IRFM) 

CALL  EOUATEC IJO, TEMPI, IRFM, ICBM) 

C  NOW  UPDATE  X.S.U  FOR  THIS  SUBINTERUAL 
C  X-SUM  OF  (PHI JTXWXXXPHI JX(DELTIM/ INTUAL ) )  FOR  ALL  JK 


out 


c  S'SUH  OP  KPHIJT*UXX*»J+PHlJT*UXU)*tMVTin/lHT«MUl) 

C  CALL  fMT4A(WIJ»UXX,IRPR»IRFfl»lRP,,»TE,,P  ' 

c  iw«R,fit;<^;.5ji  j6  'f?antsrwsi: 1 

CALL  PAT1  (TEH9 ,  BJ ,  IRFfl»  XR““,  ICsn,Tt.*rc 

CALL°«ADD"nRrH?IRF!J.X,TE2Pl.TEW.ClA^ 

« « SilSS»- 

c  s  ^*588  ™!»TS5‘-*5rf(SS«.  »»  «*«« 

▼  *  ^  _ _ ■mil 


s  UPDATE  FOR  THIS  SUB-SUB  IMTEkUAl  iw 
_ roc*  TEMP) 


!sk  > 

SS^WSiTBi’-aS'SSSU'  «-  COPPUTI 

ccntimue 

»  CONTINUE 

'  return 

EHD 


Aopendix  C 

Software  Considerations 

The  program,  LQGRP ,  is  designed  to  run  interactively 
at  a  remote  terminal  for  the  CYBER  computer  system  at  the  AFIT. 
The  program  memory  requirements  far  exceed  the  65000  octal  word 
list  for  using  a  remote  terminal  so  a  special  loading  technique, 
segmentation,  is  used.  The  segmentation  loader  actively 
manages  the  subroutines  so  that  only  those  required  for  a 
particular  program  phase  are  loaded  into  the  CYBER  central 
memory.  The  remainder  of  the  subroutines  reside  on  a  disk 
f  ile . 

One  reason  this  program  requires  a  large  amount  of 
memory  space  is  merely  that  state-space  system  models  require 
many  matrices  and  vectors  to  describe  them.  Another  reason 
is  that  the -library  of  subroutines  for  basic  matrix  manipulation 
such  as  multiplication ,  addition  and  inversion,  as  well  as 
those  used  for  more  complex  operations  such  as  integration 
and  solving  the  matrix  Riccati  equation  requi-re  all  matrix 
arguments  to  be  square  and  to  have  the  same  declared  size 
(Refs  4  and  5)..  Because  of  this,  a  large  amount  of  memory 
space  is  required  even  though  it  might  otherwise  be  unnecessary 
considering  that  the  number  of  inputs  and  outputs  in  many 
physical  systems  is  generally  less  than  the  number  of  states. 

For  example,  in  the  model  used  in  this  thesis  there  is  one 
input  and' one  output  and  five  states.  However,  in  order  to 
use  Kleinman’s  routines  all  matrices  (Ft,  Bfc,  G^,...)  must 
be  declared  square  and  at  least  of  dimension  5.  Thus,  just 
for  Bfc  and  Hfc  20  memory  locations  are  never  used. 
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In  addition  to  the  fact  that  Kle inmar. ' s  routines  re¬ 
quire  unnecessary  storage  space,  some  of  the  specialized  soft¬ 
ware  routines  £or  solving  the  matrix  Riccati  equations  require 
that  some  of  the  equations  in  the  body  of  this  thesis  be  re¬ 
arranged  in  order  to  use  the  software.  Eqs  (2.13'  and  (2.?2) 
through  (2.98)  encompass  the  most  significant  modifications. 

.  The  Riccati  equation  solver,  subroutine  MRIC ,  is  de¬ 

signed  for  controller  calculations  and  thus  solves  Eq  (2. it) 
directly.  To  s«lve  Eq  (2.13)  using  MRIC,  it  is  important  to 
note  that  MRIC  transposes  the  F  matrix  in  the  call  statement. 
Therefore,  before  using  MRIC  to  solve  Eq  (2.13).  the  F  matrix 
must  be  transposed  before  the  call  to  MRIC . 

The  modifications  to  use  subroutine  DRIC  to  solve 

Eqs  (2.92)  through  (2.98)  are  more  extensive.  First,  it  must 

be  recognized  that  DRIC  solves  for  the  steady-state  solution 

of  Kc  defined  in  Eq  (2.106).  It  is  also  necessary  to  note 

that  DRIC  will  not  solve  for  K  with  a  ncn-zero  S  matrix 

— c  — 

.(defined  in  Eq  (2.9?))  unless  the  proper  transformation  is 
used;  this  transformation  win  be  explained  later  in  this 
appendix . 

For  the  case  of  constant  controller  model  matrices, 
stationary  noise  inputs  and  constant  cost-weighting  matrices, 
Eqs  (2.92)  through  (2.98)  can  be  integrated  directly  or  they 
can  be  solved  using  the  equivalent  form.s  of  the  equations 
'Ref  10),. 

-(ti-l*  xi)=  exp  ^c(ti+l  "  ti) 


(C.l) 


(C  .  2  ) 


xi 

Qd(ti)=  j  1+1  i(ti+1,  T  )  G  Q  G T  iT(ti+1,  T)  df  (C.3) 
t  • 


X(tp=  j 

f tl+1  V  -xx  V 

xi 

dt 

(C  .4) 

D  ( t .  )  =  | 

Ci+l(f(t>  V  Mxx  sc-t,  tp 

"'i 

+  W 

^  1  J 

— uu 

4 

■  Iht,  tp  Wxu  ♦  t£u  Bit.  t 

p  )d*. 

(C.5) 

S(t,)=  /1+1  (lT(t,  t.)  Wxx  B  (t ,  t,) 
i 

-  iT(t.  V  Kxu)  dt 


(C  .6) 


where 


B(t,  ti)=  J  f(t,  <T  )  dl*  bc 
ti 


(C .  7 ) 


.The  forms  in  Eqs  (C.l)  through  (C.7)  are  used  because  they 
can  be  solved  using  the  Kleinman  subroutines  whereas  forms 
in  Eqs  (2.92)  through  (2.98)  cannot.  It  is  necessary  to 
make  approximations  to  f_(t,  t^)  and  B(t,  t^)  in  order  to  solve 
Eqs  (C.4)  through  (C.6)  using  the  Kleinman  routines. 

The  approximation  that  is  used  breaks  up  the  interval 
from  t^  to  t^+^  into  N,  equal  sub intervals .  During  each  sub¬ 
interval,  5(t,  t .  )  and  E(t,  t. )  are  treated  as  constants. 
Smaller  subintervals  provide  better  approximation  but  require 
more  execution  time,  therefore  a  tradeoff  is  required.  The 
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subroutine  that  accomplishes  the  calculations  of  X(t.),  S(t. , 
and  U(t^)  allows  the  user  to  input  the  desired  number  of  sub¬ 
intervals,  N.  JThe  routine  then  displays  X(t^),  U(t^)  and 
S(t^)  for  that  N,  and  allows  the  user  to  change  the  value  of 
1\  and  recompute. 

As  stated  above,  constant  values  will  be  used  over 
<aach  sub  interval  for  i(t,  t^)  and  B(t,  t^).  The  constant 

j. 

values  used  for  the  j  sub  interval,  i.  and  B.  respectively, 

J  J 

are  the  average- values  of  i(t,  t^)  and  B(t,  t^)  for  the  j  n 

subinterval.  $(t,  t^)  and  B(t,  t^)  are  calculated  at  the  be- 

.  t  ^ 

ginning  and  end  of  the  j  '  subinterval  as  well  as  an  mhree 

equally  spaced  points  between  the  beginning  and  the  end. 

These  are  the  values  that  are  averaged  to  form  § .  and  B.. 

v  t)  J 

Thus,  for  At=  (ti+1  -  t^) 

5  •  =  [-average  of  5(t,  t.  )  for  all  te  ft.  +  (3  -  1}  4t, 

J  I  1  l  1 


*  j  rll 


verage  of  3(t,  t^ )  for  all  te  t^  +  (3 


(C.8; 


-  1)  At  1 


t;  +  j  At 
x  N 


(C  .9' 


The  Kleinman  subroutine  DSCRT  simultaneously  returns  4(t,  C 

and  /  f( t,  f)  af  and  is  the  only  major  matrix  subroutine 
o 

needed  in  order  to  compute  §.  and  B:. 

J  J 

When  the  approximations  just  described  for  4.  and  B; 

J  C 

are  used,  Eqs  (C.4)  through  (C.6)  become 


l 


(c .ic ; 


N 

rr 

E  ( 

so  v: 

4 

)  At 

j=i' 

-J  -XX 

“I 

'  N 

N 

E 

/B^  w 

.  B 

.  +  W 

j=i 

K 

l  -J  -xa 

J  -uu 

l* 

L 

/i  .  W 

B  . 

+  i  .  W 

j=i 

\-j  -xx 

-J  ~ 

-J  -xu  -xu  -2)  Jj-  (c>11) 

)  At  (C  .12) 

N 

.  Once  values  have  been  obtained  for  i(t^+1,  t^)f  B^(t.), 

QH(t.)f  X(t.),  U(t. )  and  S (t.  )  it  is  still  necessary  to  trans- 
form  Eqs  (C.l)  through  (C.6)  in  order  to  use  DRIC ,  the  matrix 
Riccati  equation  solver.  The  transformation  of  the  LQ  sampled- 
caxa  conxroller  is  (Refs  7  and  lOj 

x(ti+i)=  I’(ti+1,  ti)  x^)  +  S’^i^  (C.13) 


where 


i'lii'  v-  i<q+i.  v  -  MV  ^"1(V  sht.)  (c.iv 


u'(ti)=  u(ti)  +  U  1(ti)  ST(ti)  x(ti) 


(C  .15) 

Row  the  quadratic  cost  equation  that  is  minimized  by 


IT  ' 

~  '  u  i  ^ 


±  ~  I  2£  (Vl  ^  — f*  —  ^N+1  ' 


N+l 


N 

+  ,I)#[xT(ti)  X’  X(ti)  +  U’T(ti)  UCt^)  U'(t; 
i  =  C  1 


(0.16) 


v.T.ere 


X’(t, )=  X(t.  )  - 

JL  1 


S(ti)  U"1(ti;  ST(tiJ 


(c .1-: 


Row  Eqs  (2.105)  and  (2.106)  can  be  put  into  the  format  of 

« 

DRIC  to  solve  for  steady-state  values  of  and  G£.  In  the 
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notation  used  in  this  thesis  DRIC  solves 

K'=  IT  K'  (  I  +  B  U-1  BT  K  )_1  5  +  K  (C . 1 8 ) 

— c  —  — c  '  —  —  —  — c  /  —  — 

I. 

which  can  be  obtained  from  Eqs  (2.105)  and  (2.106)  by  setting 
S(t.)=  0  and  using  the  matrix  inversion  (Ref  8) 

(i  -  YT  (Z  YT  +  W)-1  zj  =  (i  +  YT  W-1  z)-1  (C .  1 9 ) 

m 

and  defining  YT=  B,  W=  U,  Z=  BT  Kc  and  I  to  be  the  identity 
matrix.  Note  that  (C.19)  holds  only  when  W  (U  in  this  case) 
is  positive  definite. 

I 

Once  G*  is  computed  usir.c  the  results  from  DRIC.  G* 

— c  r  '  — c 

can  be  computed  from 

G*  +  u"1  ST  .  (C . 20 ) 

c  c 

Note,  for  ^  0  in  the  continuous-time  case,  the  trans¬ 

formation  described  in  Eqs  (C.13)  through  (C.17)  and  (C.20) 
can  be  used  if,  in  those  equations ,  the  Is  are  replaced  by  Fs , 
B,s  by  Bs  and  Ss  by  W  s.  Now  Eqs  (2.11)  and  (2.12)  can  be 
used  for  the  G*  of  the  transformed  system. 

As  can  be  seen  from  the  foregoing  discussion,  while 
Kleinman's  matrix  software  routines  are  very  powerful,  care 
must  be  taken  in  order  to  arrange  the  equations  properly  so 
that  they  match  the  arrangements  used  in  these  routines 
(Ref  5) . 


( 
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Appendix  D 


Software  Performance  Verification 

To  verify  the  performance  of  the  software  developed 
to  support  this  thesis,  several  test  cases  with  known  results 
were  used. 

For  the  continuous-time  software ,  3  test  cases  were 
>*sed.  The  first  is  example  14.25  in  Maybeck  (Ref  10).  The 
second  is  example  5*3  in  Kwakernaak  and  Sivan  (Ref  13).  The 
third  is  the  example- given  by  Doyle  and  Stein  (Ref  2).  The 
details  of  these  examples  appear  in  Table  D.l.  In  all  cases, 
the  truth  model  and  the  controller  design  model  are  equival¬ 
ent  . 

For  the  sampled-data  software,  the  same  three  test 

cases  are  used.  The  intent  is  to  show  that  as  the  sample 

period  decreases,  the  steady-state  value  of  Pv  (t. )  ar- 

xtxt  1 

proaches  the  steady-state  value  of  its  continuous-time  counter¬ 
part,  P  (t). 

xtxt 

Table  D.2  presents  the  results  of  the- software  verifi¬ 
cation  run  for  both  the  continuous -time  LQG  regulator  ar.d  the 
discretized  continuous-time  LQG  regulator.  The  results  of 
the  continuous-time  case  are  in  agreement  with  the  sources  of 
the  examples  (Refs  2  and  7).  By  examining  Table  D.2,  it  is 
evident  that  as  the  sample  period  decreased,  the  performance 
of  the  discretized  controllers  approached  that  of  their  con¬ 
tinuous-time  counterparts.  Also  note  in  the  table  that  for 
a  sufficiently  large  sample  period,  the  discretized  control¬ 
lers  do  not  approach  the  steady-state  values  of  their  contin¬ 
uous-time  counterparts  and  may  even  diverge.  This  is  ex- 
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rected  since  the  approximations  used  in  discretization  are  not 
valid  for  large  sample  periods. 

Table  Di3  presents  the  results  of  the  software  verifi¬ 
cation  runs  for  the  sampled -data  LQG  regulator  software.  As 
in  the  discretized  continuous-time  case  presented  in  Table 
D.2,  the  performance  of  the  sampled-data  controllers  approaches 
that  of  their  counterpart  continuous-time  controller  for 
sufficiently  small  sample  periods. 
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TAB IE  D.l 


Test  Cases  for  Software  Performance  Verification 


Test  Case^l  (Ex  14.25  in  Maybeck  (ReflO)  with  T=2 ) 


Program  Inputs 

Expected  Program  Outputs 

F=  [-0.5]  G=  [1] 

B=  [0.5  ]  H=  [1] 

Q=  [2]  R=  [3] 

Vl  o  *t  *  [  0] 

W  =  [  4]  0 

w”.[0]  _V'[5] 

If=  [  c. 65?1 

I;=t  0-5] 

mxt=  mu' M 

£Xt=[l-79] 

Pu=  [  0.1045] 

Test  Case  2  (Example  5-3  in  Kwakernaak  (Ref  7)) 


Program  Inputs 


‘0  1  ' 

:  o 

‘40.36" 

F= 

G  = 

K-= 

.0  -4.6. 

L  o.i. 

— f 

.814.3. 

B= 


0 

0.7871 


H=[  1  0] 

R= [  10~7] 


P  = 
— o 


liuu=  [0.00002] 


w  = 

—xx 


0  J 


Expected  Program  Outputs 


[  223.6 
®xt=  [  0 


18.69] 


o]- 


[10] 

0 

Su=  [  0  J 

■  1  O' 

0  1 

-v 

0  . 

r 1 

0] 

li 

Pit' 

'0,00004562 

o  ' 

r\ 

0.00619  . 

Zu=  ] 


^xu=  C°] 


ABLE  D.l  (con’t) 


Q=  [1] 


o  G 


v;  =  fil 

—ill]  L  J 


lest  Case  3  (Example  in  Doyle  and  Stein, 
V’ithout  Robustness  Recovery,  (Ref  2)) 


Program  Inputs 


H=  [2  1] 

£=  [i] 

-  xt  -  [0  0] 


473.3 


?xu=  Co] 


Expected  Program 
Outputs 


Kf=[  30  -50] 

GJ=[50  10] 

m  =  [0  0] 

xt 

L°] 


2800  473.31  Px  = 


-613  2C7 


Pu=[4(10)4]  _ 


Test  Case  4  (Same  as  Test  Case  3  Except  that 
Doyle  and  Stein  Technique  is  Applied) 


Program  Inputs 


all  program  input  matrices  same  as 
for  test  case  .  Then  when  V=  I_  and 

a2=  100 


Expected  Program 
Outputs 


Kf=  -[26.8  -  4o.2]T 
”  236  -613" 

Ex  = 

t  -613  1810 

Kf=  [20.4  -  1 7 . 7] T 
~  268  -613 

Ey  = 

t  6 1 3  15C0_ 

Kf=  [l6.7  -  1.9]  ‘ 
285  -613 

4  = 

t  -613  1360 


Software  Verification  Data  for  Continuous-Time  and 
Discretized  Continuous-Time  LQG  Controllers 


[4.6(10)°  ] 


TAB  LI'!  D .  2  (con't) 
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i 

{ 


TABLE  D.2  (cpn’t) 


Software  Verification  Data  for 
Sampled-Data  LQG  Controllers 


220  -613  /, 

.001  1.5  0  0  [4.07(10)  ] 

L-613  2071J 


TABLE  D.3  (con't) 


Appendix  £ 

Users  Manual  for 

Linear  Quadratic  Gaussian  Regulator  Performance  (LQGRP ) 

The  purpose  of  this  manual  is  to  describe  how  to  use 
LQGRP  to  design  and  test  Linear  Quadratic  Gaussian  Regulators. 
The  software  provides  the  capability  to  enhance  the  robust¬ 
ness  of  both  continuous -time  and  sampled-data  LQG  regulators. 
The  techniques  used  are  described  in  a  paper  by  J.C.  Doyle 
and  Stein  (Ref  2) , in_Maybeck  section  14.5  (Ref  ID), and  in  the 
body  of  this  thesis. 

Input 

The  program  always  begins  in  the  input  mod".  For  the 
first  run  through  the  program,  a  list  of  input/output  options 
(1-6)  and  a  list  of  options  to  designate  which  vector/array 
is  to  be  input  or  output  (1-21),  is  provided.  These  options 
are  presented  in  Table  E.l.  Note  that  when  entering  R^  or 
R  using  options  11  and  13  respectively,  the (value  entered 
may  be  in  either  continuous-time  or  sampled-data  format.  User 
response  to  prompts  at  other  places  in  LQGRP  is  used  to  distin¬ 
guish  between  the  formats. 

During  the  input  mode  of  the  program,  the  user  selects 
the  desired  vector/array  to  be  input,  then  follows  prompts 
about  entering  I/O  options,  dimensions  and  vector/array  ele¬ 
ments.  Note  that  opxion  18  allows  all  controller  model  mat¬ 
rices  to  be  equated  to  their  truth  model  counterparts.  The 
number  of  deterministic  states  in  the  system  models  must  also 
be  input  at  this  time  (see  discussion  under  LQG  Regulator 
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TABLE  E .  1 

Input  Routine  Options 


Matrix  Vector  Selection  Options 

Option 

? unction 

1 

Truth  model  F^  matrix 

2 

« 

Truth  model  matrix 

3 

Truth  model  matrix 

4 

Truth  model  matrix 

5 

Controller  design  model  matrix 

6 

Controller  design  model  matrix 

9 

Controller  design  model  G_c  matrix 

3 

Controller  design  model  Hc  matrix 

9 

Truth  model  initial  covariance  matrix,  Fq 

10 

Truth  model  input  noise  strength  matrix, 

11 

Truth  model  measurement  noise-  strength  matrix,  R^ 

12 

Controller  design  model  input  noise  strength  matrix, 

13 

Controller  design  model  measurement  noise  strength 
matrix,  Rc  j 

14 

Truth  model  initial  state  vector,  xQ 

15 

Control  cost-weighting  matrix,  VJ 

■  16 

State  cost-weighting  matrix,  h 

1 7 

Cress  (state -control cost-weighting  matrix,  h 

16 

Equate  F  ,  E  ,  G  ,  H  ,  Q  ,  R  to  their  truth  model 

v_*  O  U. 

counterparts 

19 

Terminate  input  mode,  start  regulator  development 
mode 

2  C 

Store  all  matrices/vectors  from  options  1-17  to 
local  file  Tape? 

21 

Read  all  matrices/vectors  for  options  1-1?  from 
local  file  Tarei 
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'ABLE  E.l  (con't) 


Input/Output  Options 

Option 

Action  Taken 

0 

Terminate  main  program 

1 

Read  entire  array  (row  by  row)  or  vector 

2 

Read  entire  array  (row  by  row)  or  vector 
and  then  print  it 

3 

Read  selected  array  or  vector  elements 

4 

Read  selected  array  or  vector  elements 
and  then  print  them 

5 

Print  the  entire  array  or  vector 

6  or 

Return  to  calling  program  without  taking  - 

greater 

any  action 

m 


Set-Up '/  . 

Once  a  truth  model  and  controller  model  have  oeen  com¬ 
pletely  entered^  ana  the  cost-weighting  matrices  have  been  en¬ 
tered,  option  20  will  store  all  this  data  to  local  file  Tape? 
for  future  use.  Cnee  a  file  Tape?  has  been  created  (and  pos¬ 
sibly  stored  as  a  permanent  file)  option  21  can  be  used  to 
^ead  data  from  it  if  it  is  first  copied  into  a  local  file 
Tape 8.  Note  any  number  of  models  can  be  entered  during  the 
input  mode  and  stored  to  Tape7  for  future  reference. 

Note  any  options  1-18,  20  and  21  can  be  executed  any 
number  of  times  during  the  input  mode.  This  allows  for  chang¬ 
es  to  be  made  to  specific  vector/arrays  in  case  an  error  is 
made.  Option  19  terminates  the  input  mode. 

When  the  input  mode  is  re-entered  at  the  termination 
of  the  performance  analysis  routine,  any,  all  or  none  of  the 
options  1-18,  2G,  21  may  be  executed. 

Stooping  LQC-RP 

LQGRP  may  be  aborted  gracefully  while  in  the  input 
mode.  Simply  choosing  any  option  1-1?  and  entering  a  zero 
for  the  I/C  option  and  (any  number  for  the  dimension  required, 
if  required)  will  accomplish  the  abort. 


IQS  Regulator  Set-Ur 

Upon  leaving  the  input  mode ,  the  program  enters  the 
IQS  regulator  set-up  mode.  At  this  point  the  user  must  cheese 
either  a  continuous-time  controller  or  a  sampled-data  control¬ 
ler.  Note,  there  is  provision  in  LQGRP  to  allow  deterministic 
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(ie,  states  which  are  not  controlled  by  input  noise)  states 
to  be  part  of  the  system  description.  Note  that  such  states 
should  be  the  first  states  in  the  state  vector  when  entering 
system  model  matrices  in  the  input  mode.  .The  deterministic 
states  are  removed  from  the  system  controller  design  model 
before  Kalman  filter  gain  calculation.  The  Kalman  filter  gain 
corresponding  to  those  states  deleted  from  the  Kalman  filter 
gain  calculations  is  set  to  2ero. 

Continuous-Time  Controller 

If  the  continuous- time  controller  is  chosen,  the  user 

has  the  option  of  calculating  and  displaying  .the  eigenvalues 

of  both  the  truth  model  and  controller  model  F  matrices,  of 

modifying  the  G  Q  G  (used  in  the  matrix  Riccati  equation  for 

calculating 'the  steady-state  P  matrix) ,  and  choosing  the  total 

run  time  and  the  time  increment  between  integration  steps. 

T 

The  modification  to  G  Q  G  referred  to  above  was  derived  by 

T 

Doyle  and  Stein  (Ref  1).  Simply,  it  replaces  G  Q  G'  by  Q(q) 
where 

Q(q)=  G  Q  GT  +  q2  B  V  BT 
o 

q  is  a  scalar  design  parameter  such  that  causes  the  LQG 
regulator  to  regain  asymptotically  the  robustness  character¬ 
istics  of  a  full-state  optimal  deterministic  feedback  LQ  con¬ 
troller.  V  is  also  a  design  parameter  that  must  be  any  sym¬ 
metric  positive  definite  m  x  m  matrix  where  m  is  the  number 
of  inputs  to  the  system  input  matrix  B.  Note,  V=  I  is  a  good 
first  choice  when  there  is  no  reason  to  weight  the  addition 
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of  pseudo-noise  to  selected  states.  The  filter  poles,  LQ 
controller  poles,  and  the  LQG  controller  poles  are  computed  if 
the  user  wants  ,to  examine  them. 

Sampled-Data  Controller 

For  sampled-data  controllers,  two  basic  options  are 
available.  The  first  merely  discretizes  a  continuous-time 

m 

controller.  The  second  developes  a  sampled-data  controller 
based  on  the  matrices  stored  during  the  input  mode. 

In  the  first  option,  a  continuous-time  LQG  regulator 
is  set-up  (see  previous  section)  and  is  then  discretized  using 
first  order  approximations.  Note  that  when  entering  the  time 
increment  for  the  continuous-time  controller  to  be  discretized, 
the  time  increment  will  become  the  sample-period  of  the  discrete 
time  controller. 

In  the  second  option,  an  appropriate  sampled-data  con¬ 
troller  is  set  up  using  the  values  entered  during  the  input  mode 
In  this  option  an  approximation  to  the  values  of  the  continuous¬ 
time  cost-weighting  matrices,  X(t^) ,  U(t^)  and  S(t^)  for 
sampled-data  controllers  is  made.  A  discussion  of  this 
approximation  Is  in  Appendix  C.  Briefly,  it  entails  using 
constant  values  for  certain  matrices  for  each  of  a  number 
of  subintervals  of  the  sample-period.  The  more  subintervals, 
the  better  the  approximations,  but  the  more  computer  time 
required . _ 

Also  in  the  second  option,  there  are  two  design  options 
for  increasing  robustness  properties  of  the  controller.  The 
first  is  a  discretized  version  of  the  Doyle  and  Stein  technique 
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described  previously  in  the  continuous-time  section.  The 
second  option  for  increasing  robustness  involves  picking  K, 
the  Kalman  filter  gain  directly  such  that 
K=  q  W 

where  I  is  the  controller  design  model  state  transition  matrix, 
Bd  is  the  discrete-time  input  matrix  and  W  is  any  nonsingular 
m  x  m  matrix  where  m  is  the  number  of  inputs  to  the  system.  The 
user  has  the  option  of  picking  any  W  or  of  calculating 
W=  (H  I-1  B^)-1  as  in  Maybeck  (Ref  10).  As  in  the  continuous¬ 
time  case,  q  is  a  scalar  design  parameter  that,  as  q-*-“,  asympto¬ 
tically  causes  the  LQG  regulator  to  recover  the  robustness 
characteristics  of  the  full-state  feedback  optimal  deterministic 
LQ  regulator.  As  in  the  continuous  time  case-  the  filter  poles, 
LQ  controller  poles  and  the  LQG  regulator  poles  are  computed  if 
the  user  wants  to  examine  them. 


Performance  Analysis 

After  the  LQG  regulators  are  properly  .formatted  by  the 
aforementioned  routines,  a  covariance  analysis  is  performed. 
This  analysis  is  described  in  the  body  of  the  thesis.  First  a 
set  of  augmented  system  matrices  are  formed  and  then  the 
performance  analysis  begins.  Eqs  (E.l)  through  (E.8)  describe 
the  augmented  system  used  in  the  performance  analysis. 


la  5a  +  *a  *d  +  G 


+  Ga  2a 


■t  —c 


xii 


(E.l) 


where 


It  +  — t  GCz  *t 


— a= 


B„„ 

— c  z  — t 


B ,  G 
-t  -cx 


^c 


(E.2) 


174 


B .  G  ' 
-t  -cy 


:y 


r^t 


B.  G^-,' 
— t  — C2 


W  = 


£t 

«-£t 


aa= 


at 


_  o.  -i 


St 


(E.3: 


(E.4; 


(E.5) 


(E.6) 


and  then 


*a(t,  toi  V<t0) 

ci 


+  /  I^t,  T  )  (1  )  ^  (T)  df 


(E.7) 


4 


(t)=  sa(t.  to)  px_x  <t0)  to; 

o.  a. 


♦fi a(t' T  >  Sa  Sa  al  )  dr  (e.s; 

*0 

Note  that  in  Eqs  (E.l)  through  (E.8)  for  sampled-data  systems 

Fs  are  replaced  by  £s  and  other  continuous-time  matrices  are 

replaced  by  their  equivalent  discrete-time  counterparts. 

The  user  has  the  option  of  printing  out  the  augmented 

system  matrices.  The  user  also  has  the  option  of  specifying 

hov;  many  time  increments  there  should  be  between  plot  points 

and  points  printed  at  the  terminal  for  P„  and  ?  ,  the  co- 

*  —  X.,  — uu 

variance  of  the  augmented  system  and  the  controller,  respec¬ 
tively. 
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The  plot  points  are  formatted  and  stored  to  a  series 
of  local  files  as  follows: 


Tape 

12 

£*txt 

Tape 

13 

!2u  - 

Tape 

14 

Euu  - 

Tape 

15 

where  m  is  the  mean  of  the  truth  model  states,  „  is  the 
-xt  xtxt 

covariance  of  the  truth  model  state  (  only  diagonal  entries 
are  written  to  Tape  13) »  mu  is  the  mean  of  the  controls  gen¬ 
erated  and  P.  is  the  covariance  of  the  controls  generated 

lili 

(only  diagonal  entries  are  written  to  Tape  15). 

Each  performance  analysis  run  is  tagged  with  a  run 
number,  total  time,  sample-time  and  the  dimension  of  the  state 
vector  or  control  vector  as  appropriate .  This  is  the  first 
record  of  information  written  to  the  local  files,  Tape  12 
Tape  15  for  each  run.  The  last  two  records  written  to  these 
files  for  each  run  contain  the  minimum  value  of  the  data  array 
and  a  scale  factor;  both  are  needed  for  plotting. 

Upon  exit  from  the  performance  analysis  routine,  the 
program  re-enters  the  input  mode  and  changes  the  run  number. 

Plotting 

In  order  to  plot  the  data,  it  is  necessary  to  abort 
the  LQGRP  program  and  execute  the  plotting  program,  MYPLOT 
on  a  terminal  connected  to  an  HP  plotter.  If  the  HP  plotter 
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is  unavailable  or  unacceptable  for  some  reason,  MYCLPT  will 
generate  a  Calcomp  plot  file  at  a  terminal  that  can  be  routed 
to  the  Calcomp  plotter. 

Either  MYPLOT  or  MYCLPT  reads  data • formatted  by  the 
performance  analysis  routine  off  any  local  file.  Tape  xx 
(where  xx  is  12,  13,  14,  or  15).  Note  that  if  the  user  wishes 
to  do  any  manipulation  of  the  data  tapes  before  using  this 
program,  the  result  can  be  stored  on  any  tape  numbered  1 
through  99.  This  number  can  be  used  in  place  of  12-15  as 
indicated  earlier.  Before  plotting  it  gives  the  user  the 
option  to  preview  the  data.  Note,  when  previewing,  the  user 
should  check  to  be  sure  the  last  two  data  entries  are  the 
minimum  value  and  the  scale  factor,  respectively. 

After  each  plot,  the  user  has  the  option  to  abort, 

Dlot  a  different  variable  (ie,  x,  instead  of  x  ),  read  and 

t2  Z1 

plot  the  next  run  of  data  from  the  same  tape,  cr  read  and 
plot  data  from  a  new  tape.  All  options  executed  in  either 
program  are  results  of  user  inputs  to  self-explanatory  program 
prompts  printed  at  the  terminal . 


A  Typical  LQG  Regulator  Performance  Analysis  Session 
with  LQGRP  and  MYPLOT  or  MYCLPT 

1.  Preliminaries 


A.  At  the  beginning  of  the  program  it  is  necessary 
to  have  available  for  input  the  matrices  listed 
in  Table  E.l,  options  1  through  17  (Could  all  be 
on  local  file  Tape8  saved  from  last  run  using 
option  20) .  The  number  of  deterministic  states 
in  the  model  is  also  needed,  (if  any,  they  must 
be  the  states  listed  first  in  the  system  descrip¬ 
tion)  . 

B.  Attach  LQGRP. 

C.  Be  sure  the  INPUT  and  OUTPUT  files  are  connected 
to  the  terminal. 

D.  In  response  to  COMMAND  type  LQGRP. 

2.  Input  Mode-  Always  begins  with  a  printout  of  the  "run 
number"  (got  here  from  l.D  above  or  4  bel.ow) 

A.  Respond  to  prompts  about  entering  matrices  (note 
the  information  in  Table  E.l  is  printed  at  the 
beginning  of  the  first  run  of  LQGRP) 

B.  £f  desired,  use  option  20  to  save  all  matrices  on 
local  file  T?.pe7. 

Cl.  Terminate  input  mode,  using  option  19 

C2.  Terminate  program,  using  any  option  1-17  and  I/O 
option  0  (and  any  dimension  if  required  by  prompt, 
see  section  5  below) 

3.  Regulator  Setup  Mode  (got  here  from  2. Cl  above) 

A.  In  response  to  prompt  type 

1.  C-  for  continuous-time  LQG  controller 

2.  D-  for  discretized  continuous-time  or  sampled- 
data  LQG  controller. 

Bl.  (got  here  from  3.A.1) 

1.  Respond  to  self-explanatory  prompts  (note  time 
increment  required  by  prompt  controls  maximum 
number  of  points  from  time  0  to  run  time  and 
does  not  affect  the  accuracy  of  any  results. 

B2 ,  (got  here  from  3. A. 2) 

1.  In  response  to  prompt,  choose  to 

a.  Discretize  a  continuous-time  controller  or 

b.  Choose  a  sampled-data  controller 
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2a.  (got  here  from  '3  *B2 . 1  .a ) 

1.  Note  that  when  entering  time  increment  for 
continuous-time  controller  it  will  become 
the  sample-time  of  the  discretized  con- 
v  troller  and  affect  stability. 

-  2.  Follow  the  remaining  prompts. 

2b.  (got  hero  from  3-B2.1.b) 

1 .  Answer  prompts 

2.  In  response  to  prompt  about  subinterval 
for  calculating  X,  S  and  U,  remember  a 
better  approximation  is  obtained  for  more 
subintervals  but  that  this  requires  more 

.  b  computer  time . 

3.  Follow  remaining  self-explanatory  prompts. 

4.  Performance  Analysis  Mode  (got  here  from  3-B1  or  3>B2) 

A.  Be  careful  in  selecting  number  of  prints  at  termi¬ 
nal  (in  response  to  prompts)  of  m  ,  m  ,  P  and 

F  since  the  printouts  require  xa  u  xa 
ausignif icant  amount  of  time  and  paper. 

B.  Be  careful  in  choosing  the  number  of  points  to  go 
on  the  plot  files  (in  response  to ’prompt)  since 
the  number  of  points  significantly  affects  plot¬ 
ting  times.  (For  example,- 100  points  plotted  on 
the  HP  plotter  takes  about  5  minutes,  200  points 

approximately  10  minutes  etc .  V.'ith  200  points 

to  be  plotted,  there  will  be  more  than  20  points 
■plotted  per  inch  since  the  time  axis  of  the  plot 
is  scaled  to  7 t  inches). 

5.  Data  File  Plotting/Storing  (got  here  from  2.C2) 

A.  If  data  was  saved  on  Tape?  using  option  20,  now 
is  the  time  to  create  a  permanent- file  of  this 
data  (see  terminal  operations  manuals) 

Bl.  If  you  don't  have  time  to  plot  the  data  on  local 
files  Tapel2,  Tapel3,  Tape I 4  and  Tape  15,  now  is 
the  time  to  create  permanent  files  for  this  data. 

B2.  bant  to  plot  data  from  todays  run  or  from  previous 
runs  stored  on  permanent  file . 

1.  Make  sure  files  are  rewound  before  use 

2.  Attach  copy  of  MY PLOT  or  MYCLPT  depending  on 
v.’here  you  want  the  plots  made  . 

a.  Type  MYPL0T  or  MYC LPT  in  resoonse  to  "COM¬ 
MAND  ". 

b.  Follow  prompts  (nets  Calcomt  rlotter  at 
AFIT  can  only  handle  5  plots  per  plot  file . 
It  is  necessary  to  terminate  MYC1PT  (fol¬ 
lowing  self-explanatory  prompts)  after 
each  set  of  5  plots  is  created.  Then  the 
plot  file  should  be  routed  to  the  plotter, 
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can  be  re-entered  for  the 


and  then  MYCLP" 

next  5  plots).  ,  n  t  file 

nation  of  MYCLPT. 
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Appendix  F 


Apollo  Mode  1  Performance  Data 

This  appendix  contains  additional  mean  and  covariance 
plots  used  to  support  the  results  and  conclusion  of  Chapter 

III  • 
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b)  variance  of  state  1  d)  variance  of  state 

2 

Fir  F.'?  Hnmpjn d-data  performance  with  =150  in  the  Apollo  model 


b)  variance  of  state  1  *  d)  variance  of  state 

2 

Fig  F.6  Sampled -data  performance  with  =300  in  the  Apollo  model 
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